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ie INTRODUCTION 


A. GENERAL CONCEPT 
The need to improve industrial productivity has greatly 


motivated the implementation of a variety of forms of 


automation. With respect to this fact, programmable multi- 
functional manipulators (robots), have become increasingly 
important. Due to the fact that the robots will play a 


major role in future manufacturing systems, the need for 
improvement of robot's performance becomes imperative. 

One of the major drawbacks of today's robots is that in 
general they are very slow. The speed, with which they can 
transfer objects from one point to another, is at many cases 
limited by the weight of the manipulator arm. The excessive 
arm weight not only hampers the rapid motion of the mani- 
pulators arm, but also increases the robot's consumption of 
energy and the size of the required actuators. 

A flexible manipulator is free of these drawbacks, 
because it requires less material that results in less arm 
weight, less power consumption and increased maneuverability 
compared with the traditional (rigid-arm) manipulators. The 
flexible manipulator also uses smaller actuators because of 
the smaller power demand. 

Therefore flexible arm manipulators are particularly 
advantageous in small lot manufacturing and also very 


attractive for space applications. 


Manipulator arms require a reasonable accuracy in the 
response of the arm's end-point to the joint control system 
input commands. In order to achieve this accuracy most of 
the manipulator's arms exhibit some vibrations. These 
vibrations have been eliminated by increasing the rigidity 
of the manipulator's arm. 

In the case of the flexible manipulators the above 
solution is unsatisfactory if their basic advantages stated 
above are not to be sacrificed. 

It is clear that in order to realize the very attr- 
active features of the flexible manipulator arm, extensive 
research has to be performed in both the areas of design and 
control of the system. Obviously a control system has as 
tasks to perform the required motion for the flexible arm of 
the manipulator with a reasonable accuracy in the arm's end- 
point position, but also to control the vibration modes of 


Its Links. 


las THESIS OBJECTIVE 

The manipulator that will be used through this thesis 
will be a two links planar robot arm having the first link 
rigid and the second link flexible. 

Controlling the proposed manipulator to obtain position 
accuracy of the end-point, fast response and control of the 
Vibration modes of the flexible link is a very complicated 


problem because the dynamic motion of the manipulator is 


strongly influenced by mechanical design and physical 
properties of the manipulator, as well as environmental 
effects. Coupling inertia, coriolis forces, actuator 
EemamlLcs, jOlnt friction, centripetal forces, gravity 
effects and mainly the vibration modes introduced due to the 
elastic motion of the flexible link and the coupling of the 
two links create an overall system that is a very nonlinear 
dynamic system. Because of the nonlinear dynamic model of 
the manipulator a robust and flexible control system is 
required. 

The velocity curve follow technique 1s a powerful 
control scheme that was successfully used to control a 
Single flexible arm [Ref. 1] and also for a near minimum 
time positioning of a planar robot arm with two rigid links 
(Ref. 2]. A feasibility study will be done in the appli- 
cation of the same technique, the velocity curve follow 
control scheme, for the proposed manipulator model. ie 
order to compare the results of the proposed rigid-flexible 
planar robot arm, for fast and accurate response, with the 
results of a planar robot arm with two rigid links, the 
model of a rigid-rigid planar robot arm having similar 
parametric data and using the same adaptive control scheme 
will be developed and tested. 

The advantages of this technique are the adaptive 
nature and the simplicity of the control scheme loop, that 


can also be implemented in a digital computer or micro- 


processor with the output signals through a D/A converter 
used to drive the motors acting on the manipulators joints. 
Problems arising from modelling uncertainties, unpredictable 
environmental changes and noise contamination of the signals 
can be taken into account and solved through the adaptation 


procedure. 


c: BASIC CONCEPTS OF THE ADAPTIVE MODEL 

A very simplified block diagram of the adaptive control 
scheme that will be used is illustrated in Figure 1.1. In 
order to control the motion of the manipulator's links the 
adaptive control scheme receives from the actuator the 
position of each link. Knowing the position and previous 
values of the position, the digital computer calculates the 
velocity and updates the gain constant, the position and the 
velocity of the second order model, used to model the real 
motor in the computer, at certain time intervals. Another 
advantage of this control scheme, concluded from the basic 
implementation described above, is the elimination of a 
tachometer requirement. 

The block named 'Curve follower', approximates the 
deceleration curve of an ideal motor. This curve can be 
obtained as an analytic expression or as a table look-up 
stored in the memory of the digital computer. 

The 'Model-environment' block represents the dynamic 


equations that describe the given system. In this block are 
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Figure 1.1 Simplified block diagram of the system. 


also included gravitational torques, centripetal forces, 
coriolis forces, inertia of the loaded arm, forces acting on 
the rigid and the flexible links due to the elastic motion 
of the flexible beam. 

The motors acting at the two joints are identical, 
using the same adaptive velocity curve follow control 
scheme. At the adaptive model both actuator and ideal motor 


are driven by the same velocity error input. 


D. ORGANIZATION OF THE THESIS 

In Chapters II and III the mathematical models for the 
rigid-rigid and rigid-flexible two links planar robot arm 
will be developed respectively. 

Some preliminary studies of the models will be per- 
formed in Chapter IV, including frequency response of the 
systems which will help to extract, some important for the 
adaptive model, data from the prominent physical chara- 
cteristics of the systems. 

The development of the computer simulation model, that 
will be used in both cases, will be derived in Chapter V, 
where the velocity curve follow control scheme will be 
developed and simulated. 

In Chapter VI, the velocity curve follow will be 
applied as the control scheme of the rigid-flexible planar 
robot arm, described by the model derived in Chapter III, in 
order to investigate if this control scheme is applicable. 
Simulations under different conditions (load, gravity 
environment) will be performed. Simulation results will be 
obtained under the same conditions for the rigid-rigid 
planar robot arm, described by the model derived in Chapter 
II, and the results will be compared. 

In Chapter VII, the conclusions and the requirements 


for further studies will be given. 


ha Be MODEL DEVELOPMENT FOR THE TWO RIGID LINKS 


ROBOT ARM 


vs INTRODUCTION 

In this chapter, a mathematical model of a planar robot 
arm with two rigid links will be derived by the use of 
Lagrangian mechanics. The planar robot arm having two rigid 
links was partially investigated in Ref.2. In order to 
compare the resulted equations of motion and the performance 
of the planar robot arm at two different cases, one when 
both links are rigid and the other when the second link is 
flexible, the study of the two rigid links planar robot arm 
will be repeated in this thesis. 

Lagrange's equations will relate the torques and forces 
acting on the system to the position, velocity and accele- 
ration of each link at any time. Therefore, the second 
order differential equations that will be derived following 
this Lagrangian dynamics approach will be the equations of 


motion, that describe the system. 


B- DEVELOPMENT OF THE MODEL 


The two rigid links planar robot arm is illustrated in 


Poragure 2.1. Both joints are rotary joints and the motion 
W1ll be considered to be on one plane, the xy plane. The 
two links having lengths 1, and 15, are assumed to be 
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Figure 2.1 Planar robot arm with two rigid links. 


massless and two equivalent masses m; and mj are lumped at 
the end of LINK1 and LINK2 respectively. The driving 
torques for the motors at each joint will be denoted as [, 


and [5 at JOINT1 and JOINT2 respectively. 


age DERIVATION OF THE LAGRANGE'S EQUATIONS 
Defining the Lagrangian function L, as L=T-V, where T 


and V are the Kinetic and potential energies of the systen, 
8 


the equations of motion that describe the system will be 


derived from the Lagrange's equations defined as: 


om ( on ) = it = oe i= I eye oe (2= 1) 
oe Sc 5 
ohn qa 
where: 
q, = the generalized coordinates, 
a = the generalized forces, 
n = the number of degrees of freedom. 


For that system configuration only two coordinates will 
be used, because the number of degrees of freedom must be 
equal to the number of coordinates which must be used to 
@esecribe that system. Selecting the angles 9, and @5 to he 
the generalized coordinates for the system shown at Figure 
2.1, the position of both arms at any instant of time, with 
Segecant lengths 1, and 15, will be exactly specified from 
these two angles. The torques [1 and [5 will be the gene- 
ralized forces acting on that system. Derivation of the 
kinetic and potential energies and construction of the 
differential equations from the Lagrangian function L is a 
very lengthy approach and the detailed presentation is given 
in Appendix A. The pair of the second order nonlinear 
differential equations derived in Appendix A, will become 
the equations of motion that describe the system and will be 
used as the mathematical model at the studies of the two 


Eagid links planar robot arm. 


Pr, = (Dy + J,)8; + Dig 8 + Dize % 
(2.2) 
+Di 42 95 95 2 Dini 2 eT Dy 
ie ies “5 
r’, = (D,5+ J,)9, ~ Do4 eo, 4 D541 e, + D. (253) 
where 
D = (m,+m vic + m ie + 2m), 1 cese 
11 1 2 ak 2 2 a ES, 2 
_ Ps 
Doo = M15 
as oa 2 
Di> = Do, = m1, + mj1,1,cose, 
Daze = Praag = Mya. = ~Poaa = ~Mo1y1281"92 
D, = (m,+m.,)gl,sino, + mogl.,sin(6, +0.) 
D. = m,gl,sin(6,+8.) 
J, = the inertia of Ehe Motor at JOLT: 
J. = the inertia of the motor at JOINT2 
g = the acceleration of gravity ( = 9.814 m/sec’) 


The parametric values, lengths of the links and masses at 
the end of each link, that will be used in this study of the 
two rigid links planar robot arm are given in the Table 2.1. 

The Dj; (i=1,2) values defined in the above equations 
were obtained from the forces acting on each link due to 
acceleration and velocity of the moving robot arm. A more 
detailed specification for each value will be given as 


follows. 
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TABLE 2.1 PARAMETRIC DATA OF A TWO RIGID LINKS PLANAR 
ROBOT ARM. 


0.40 m 
0.32) m 

2 

0.30 kg/m/sec 


OF05 kg/m/sec 


0.10 kg/m/sec* 
(with load) 





An acceleration of the joint 1 causes a torque at the 
Bame gjOint equal to D;;8;, therefore at this particular 
maocem Di, and D55 represent the effective inertias for the 
joints 1 and 2 respectively. Also an acceleration at one 
Joint i will cause a torque at joint j of the form D45945, 
and for the particular system Dj5 and D5, are the coupling 
inertias. Also a velocity at joint i will produce a centri- 
petal force at joint j having the form D+44;9;, and therefore 
Di22, Do11 are the centripetal forces for that system 
(notice Dj 111=D222=0). A combination of the form Dj4,040, 
+Di,j9x«94 are the produced coriolis force acting at joint 1 
due to the velocities at joints k and j, therefore for the 
two link model the coriolis forces will be represented by 


Beiewcoriolis acceleration coefficients Dj15, Dy9 1, Do12 and 


D221° 


inal 


ELL: MODEL DEVELOPMENT FOR A PLANAR ROBOT ARM 





WITH TWO LINKS, THE SECOND FLEXIBLE 


Bs INTRODUCTION 

The basic mathematical model that will be used in the 
computer simulations for the planar robot arm with two 
links, the first rigid and the second flexible, has to be 
derived. In order to examine its performance and to compare 
the simulation results with the results obtained for the 
planar robot arm having two rigid links, the two models have 
to be compatible. Therefore the mathematical model of a 
rigid-flexible planar robot arm, will be derived in this 


chapter. 


Be PRIOR WORK IN THIS FIELD 

From previous works and studies in the field of robotic 
manipulators with structural flexibility many different 
approaches can be used on the derivation of the different 
models. Book [Ref.3] applies the transfer matrix method to 
describe in the frequency domain the elastic bending motion 
of a two-link planar elastic arm and for small angular 
velocities. In later work Book [Ref.4] considered the 
linear dynamics of spatial flexible arms represented as 
lumped mass and spring components via 4x4 transformation 
matrices. Maiza-Neto [Refs.5 and 6] develops the nonlinear 


equations of motion in the time domain for the same problem 


iz 


using Lagrangian dynamics. Usoro [{Ref.7] uses the finite 
element/Lagrange methods coupled with the concept of a 
generalized inertia matrix, derived for lightweight flexible 
manipulators, to achieve positional and vibration control, 
with the mathematical background for this study presented by 
Mahil [{Ref.8]. Schmitz [Ref.9] applies Hamilton's principle 
and uses boundary conditions to linearize the model of a 
very flexible one-link manipulator in order to describe its 
performance with transfer functions for the end-point 
Besittion control. The latest procedure was followed by 
Zouzias [Ref.1] in his attempt of controlling a flexible 


manipulator arm with an adaptive computer simulation model. 


e DEVELOPMENT OF THE MODEL 

For the sake of the comparison of the two cases, as was 
mentioned before, Lagrangian dynamics was decided to be used 
for the model development of the two links planar robot arm 
having the first link rigid and the second link flexible. 
The model of the planar robot arm, that will be used through 
this thesis, is illustrated in Figure 3.1. Both joints are 
rotary joints and the system will again assumed to have only 
planar motion, on the x,y plane, with relative motion of the 
two links due to the torques applied from the motors at each 
joint. The torques applied at JOINT1 and JOINT2 will again 
Penpdenoted as 1) and I>. Both links, rigid and flexible, 


having lengths 13 and 15 respectively are assumed to be 


13 
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Figure 3.1 Two links (rigid-flexible) planar robot arm. 


massless and two equivalent masses m, and mp are lumped at 
the end of each link. The discrete masses at the end of the 
rigid and the flexible links represent the servo motor of 


the flexible beam and the end-point sensor and payload. 


D. DERIVATION OF THE LAGRANGE'S EQUATIONS 
The model will be developed by superposing the flexible 


motion of the second link over the two rigid links body 
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motion. This approach is in favor of the finite element 
Lagrange method because will there result a set of second 
order differential equations similar to those obtained for 
the two rigid links planar robot arm, with additional terms 
due to the flexibility of the second link and the coupling 
effects between the rigid and the flexible link. 

The coordinates for the rigid beam, first link, will be 
defined as in the "two rigid links arm model". For the 
second link, that is now a flexible beam, the coordinates 
will be defined as if the beam was rigid superposing in this 
result the flexible motion. In order to describe this 
flexible motion the general schematic of the model will be 
repeated in Figure 3.2 introducing three reference frames. 
These references frames can be defined as follows: 

[O,X,Y] : an inertial reference frame with origin at JOINT1. 
[O,X1,Y,] : a reference frame with origin at O and the Xj, 
axis lying on LINK1. 

Mle, .>) + a Eeference frame with origin at 0, and with 
the X5 axis tangent to the flexible beam at the point 04. 


The two angles can therefore be defined as follows: 


QO, Wes Le ssctwCene the axis x and x). 
O65 = the angle between the axis Xj, and Xp. 

The overall motion oan be understood as a motion of the 
hypothetical rigid system 00,05 and a flexible motion of the 


second beam, LINK2, with respect to this moving system. The 


position of any point of LINK2 can be described by a 


1) 


convenient definition of a set of coordinates. As indicated 
in Figure 3.2 any point P along the flexible beam Camiiee 
specified if a new variable u(x5,t) will be defined as being 
the coordinate of the flexible motion with respect EGmeeae 
reference frame [01,X5,Y9]. The position (coordinates) for 
any point P of the flexible beam will then be given in 


Vector notartroneas. 


—- —_» 
Rg = [1,coso,+ xX, COs (0, +0.) ee Ul Ssin(®,+9.,) ] a. 
Cote) 
. ——— 
+[1,sino,+ x,Sin(®,+9,) 12 bl cos (0, +9.) ] a, 


Therefore the Cartesian coordinates of the end-point of the 


flexible arm can be expressed from the following equations: 


x 


5 1,cos® 


as 1,cos(0,+0,) = Sin(0,+9.,) (322) 


1 E 


= 7 J3 s ; 
Ms, 1,s1ino 1,sin(0,+9.) ap Ul cos (0,+0,) (are ) 


1 E 


where Up is the flexible linear displacement at theese 
point of the flexible beam (LINK2). 

Having defined the coordinates transformation for the 
flexible beam, as given in the above Equations 3.2 and 3.3, 
Lagrange's equations can normally be derived. In order to 
develop a mathematical model for the proposed system the 
flexible displacement u(x5,t) must be given by a closed form 
expression. 

In general for any arbitrary point of the flexible beam 
the corresponding flexible displacemene, a(x) =) cia el ele 


Superposed to the hypothetical motion of the two rigid links 
als: 


| Gravitational Force 
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Figure 3.2 Vector position for an arbitrary point P at 
the flexible beam of the planar robot arm. 


system can be expressed using the so called assumed-modes 
method. The assumed-modes method was described in detail in 
Ref. 10. In the case of a free vibration problem the basic 


idea is the assumption of a solution, in the form of a 
7 


series composed of a linear combination of admissible 
functions fj; multiplied by time dependent generalized 
coordinates gj (t)- By admissible function 1s meant any 
arbitrary function of the spatial coordinates satisfying all 
the geometric or essential boundary conditions. Then for 
the case of the flexible displacement of LINK2 it is 


possible to assume that: 
n 
u= 2 £.(x,) g; (t) (3.4) 


where the admissible function fj;(x5) must satisfy the 
geometric boundary conditions with respect to the represent- 
ation of LINK2 “im the seterence frame (C7 4 >... 

From the above it 1s clear that the assumed-modes 
method treats a continuous system as an n-degrees of freedom 
system. Therefore the degrees of freedom for the overall 
system will be increased from 2 to n+2, and the new system 
Will be represented with n+2 generalized coordinates that 
are 0), ©5 and gg; where j-l) 27 uw. 

Increasing the number of degrees of freedom by 
increasing n, the estimated natural frequencies of the 
system will approach the true natural frequencies from 
above. Using a large value for n for a more accurate model 
of the flexible beam, the number of the generalized coordin- 
ates will also increase making the analysis of the system 
and the derivation of the mathematical model through 
Lagrange's equations a very unrealistic approach. The 
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system can be simplified with the assumption that the ampli- 
tudes of the higher modes for the flexible link are very 
small compared with the amplitudes of the first modes. 
Therefore, aS was indicated in Ref. 5, the higher modes can 
be neglected and the system can be truncated with n=2, 
resulting in a four-degrees of freedom problem. [In order to 
verify the stated assumption, that the modes with n23 can be 
neglected, the equations of motion are derived in Appendix B 
for a planar robot arm having only one flexible link by 
using the Lagrangian dynamics method. The elastic motion of 
the flexible beam that will superposed to the hypothetical 
rigid motion of the arm will have a flexible displacement 
approximated by the assumed-modes method. In Appendix B, 
models were developed for this flexible planar robot arm 
uSing the assumed modes with n=1,2 and 3 respectively. The 
resulting models were used with the adaptive control scheme 
(derived in Chapter V) in the simulation studies of this 
flexible beam. Three different DSL programs were written 
for these simulation studies, with the source programs given 
in Appendix C. The resulting phase plane and step response 
plots in the cases where n=1,2 and 3 are shown in Figures 
a> co 3.8. From the analysis presented, comparing the 
results obtained for the different cases of n used one can 
observe that the step responses for n=2 (Fig. 3.8) and for 
n=3 (Fig. 3.8) have essentially the same duration and almost 


the same oscillatory characteristics. Thus it was concluded 
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Phase plane of the flexible beam (n=1). 
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Phase plane of the flexible beam (n=2). 


Figure 3.5 
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Figure 3.6 
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that the use of the value n=2 for the assumed-modes was a 
satisfactory assumption. Due to the previous analysis 


Equation 3.4 can be truncated obtaining the form: 
Wi eens) =: ex) 5) (2Esh 


with the flexible displacement and velocity at the end of 


the LINK2 given as: 


Uu = f 


E 1E97° * 


oRI> (3.6) 


‘sl = f 


E 1E°%1 (a 


bac 
From that point the derivation of the Lagrange's 
equations becomes a solvable but also lengthy and tedious 


problem. Forming the Lagrangian function L, from the 


general form of the Lagrange's equation 








) na . Q. 1=1, 27372 (3.8) 


a set of four nonlinear second order differential equations 
can be derived, where the generalized coordinates will be 
given aS q}=907, 42=@2, 43=9,; and q4=g>. From the definition 
of the generalized coordinates for the proposed system it is 
possible to show that the generalized forces obtain the 
values Q)=T], Q9=F> and, Q3=0O4=-0, whene f, and 15 are meme 
torques applied to the motors at JOINT1l and JOINT2 
respectively. 

With the complete derivation of the Lagrange's equati- 


ons given in Appendix D, the final form of the differential 
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equations that describe the system and that will be used as 


the basic model through that thesis will 
follows: 
gg) 8 Pp a0Pa PP TR8 Sr PO r4492 
ey oe eo a 1S 
+D oe? +p._.6.g. +D...0.g. +D 
LODD" ye eee 88 oye el 
Me oo a00 2) 2p 903391 7 Po4092 
FD 13949, 199749190 
Mme ola) “tb... 6.q. 4D e2 +p 
Peele 1111 
Me 322 343501 98 3449o 793408475 
2a “5 
4349197 1932929 TY 
BF 8 149282 7943391 P4492 792199192 
“5 “9 
eae Meee ey wn 
where 
e 2 : , 
Do41 = Di oot (mi +m,) 1 +m,1,1,cose. m,1,sino0,U, 
7 2 2 - | 
D455 = molj+m,U,t+m,1,1,cose,, m.,1,sinoe,U, 
D133 = mjlj,cos©.,f,,+m,l,fi, 
Digg = Mol, cos©,f,,tm,1,f55 
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be 


given as 


(3.9) 


eran 


(aaa 


(see) 


Di45 = —2m., 1 1 (cos85U, +] >$ine,) 
Degg = 2M fae (eens 
OPPS Cy eR ln, 
D1 555 = “m1, (1,sin0,+cose,U,) 
elie ie 
mie we SLi 
D, = [(m, +m,)1,cos®,+m,1.,cos(9,+®.,)-m,U,sin(9,+®,) ]g 
Sie Wee 
D =m een U 
ele, Dees 
Pm = ey aio” is 
DOA = 2204 eee) rer 
Das a ae 
SP Vien ee Sys 
D6 441 = m,1,1,sine,t+m,1,cose,U, 
D., = [m,1.,cos(0,+6,)-m,U,sin(0,+0,) ]g 
D444 = m,£,(1,cose,t1.) 
Dy) me eee) ihn 
eoene mf ip 
Se tee 
Py ae oye a aha 
Popo. = go eaten 
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D344 = 83222 bMo1 tips, 

D., = gm,f,,cos(0, +0.) -KW,g, 

Dasa = Molafor 

Dara = PazatMot  FopO08?, 

D433 7 344 

7 2 

Daag ~ "ol ox 

Daig = ~2Mof ope 

Daoe2 = “MofapUp 

Data ~ Paz22tMoty fo p81N9> 

D, = gm, f., ,cos (0, +9.) -KW.g, 
a - 

KW, = EI I, £, (x) £, (x) ax 
ie - 

KW, = EI | f. (Xx) f. (x) dx 
0 

J, =eicminiaotthamot the motor 

J. S—eViomrnerk iawor the mower 


at 


at 


g = the acceleration of gravity 
U 


=f 


E 1F9,7F 


2EY2 


E is the Young's modulus, 


Seeeche beam cross section. 


= the end-point 


and I is 


The admissible functions f; 


the eigenfunctions of a clamped-free beam. 


(Guat) 2) 


HOUND 
JOINT 2 


(= 9.814 m/sec”) 


displacement 


the second moment of area 


are assumed to be 


ACeGOGaing to 


Ref.11 the restrictions for the geometric boundary conditi- 


29 


ons will be satisfied because of the orthogonality of these 


fuUneELONS : 
1 ieee 8 
= = O , rF#S 

[fp 00 f(x) dx = I f-(%) f(x) dx = | 1, r=s (3 Bs) 
with 

f(%) = cosh (ux) -cos (ux) -o [sinh(# x) -sin(H x) ] (3.14) 
where, r is the mode of vibration. 

Sinh(u x) -sin(“,x) 
CO = Se ee (3 2155 


r cosh (Hx) +cos (ux) 


with sinh and cosh to be the hyperbolic sine and cosine 


functions respectively, given as: 


Pe 

sinh(x) = ——>—*- (3.16) 
ao SE. tier 

cosh(x) = —?—>—S- (35m 


Because the model takes into account only two modes for 
the vibration of the flexible beam, the superscript r will 
obtain the values 1 and 2. The values for #,~ and o,, atmeme 
end-point of the flexible beam where x = 1, will then be as 


given in Table 3.1. 


TABLE 3.1 CHARACTERISTIC VALUES FOR A CLAMPED-FREE 
BEAM. 


aod 2a 0.7341 


=, 4.6941 1.0185 






Because of the orthogonality identity of the assumed- 
modes the flexible component of the potential energy will be 


evaluated as follows: 





KW_= at r=1,2 (aes) 


with EI the beam stiffness, mw the density per unit length 
Moe, che flexible value given above for the rth mode. 
Therefore the values of the flexible components KW; (1=1,2) 
of the potential energy can be computed, and they will be 


even in Table 3.2. 


TABLE 3.2 PARAMETERS FOR THE ELASTIC COMPONENTS OF THE 
POTENTIAL ENERGY. 


he 





The other parametric values, lengths of the links and 


discrete masses that are lumped at the end of each link, 
that will be used in this thesis for the study of the two 
links planar robot arm (with the first link rigid and the 
second flexible) are given in Table 3.3. 

The Dj; (1=1,2,3,4) values defined in the above 
equations were obtained from the forces acting on each link 
due to acceleration and velocity of the moving robot arm as 
was done in the case of the two rigid links planar robot 


arm. Additional terms are due to the forces introduced by 


ou 


the flexible motions of the second link and the coupling 


forces acting on the system. 


TABLE 3.3 PARAMETRIC DATA OF A RIGID-FLEXIBLE PLANAR 
ROBOT ARM. 
0.40 m 
O2o2 mM 
kg/m/sec2 


kg/m/sec? 


kq/m/sec2 
load) 
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HY co PRELIMINARY STUDIES USING THE COMPUTER SIMULATION MODEL 


Ave INTRODUCTION 

The second order models derived in Chapters II and III 
for the rigid-rigid and rigid-flexible planar robot arms 
respectively will become the mathematical models for this 
case. Each arm will be driven, open loop, by a servo motor. 
The servo motors have to follow a predetermined curve until 
the desired position is reached. In order to achieve this 
the states of the second order model have to be adapted such 
that the computer model mimics the position and the velocity 
of the actual servo motor with equivalent gain constants. 

For the sake of the analysis identical servo motors are 
used independently at each joint to provide the proper 


torques for the required movements. 


ee SERVO MOTOR SELECTION 
From Ref. 12 the equivalent transfer function of a 
servo motor can be expressed as: 


@(s) Re 


= (4.1) 
cee) Se il) eal) 





with the parameters 9, V, Ky, Kt, J, R and L obtained from 
the data of the specific motor to be used. For the purpose 
of this thesis a permanent magnet motor drive currently used 
in industrial robots was selected. The parametric data for 
this motor obtained from Ref. 13 are listed in Table 4.1. 
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TABLE 4.1 PARAMETRIC DATA FOR THE JOINT SERVO MOTOR. 


Torque constant 1037, gr-m/amp 


Motor inertia 0.024 gr-m-sec? /rad 


Damping coefficient Ol as) 1 gr-m-sec/rad 


Back-emf constant O One? V-sec/rad 
Armature inductance 0.0001 H 


Terminal resistance 0.91 2 





Adding a large inertia to represent the arm of the robot to 
the motor inertia given above the mechanical pole of the 
motor becomes very small. Since R/L represents a large 
number the electrical pole of the motor becomes large with 
no significant effect on the response of the servo motor and 
can be neglected. Therefore the transfer function of the 


servo motor can be approximated as: 


O(s) Km 
= (4.2) 
V(s) s? 








where the value of K, will be computed from the preliminary 


studies of the arm-motor systems given below. 


e: ANALYSIS OF THE ARM-MOTOR SYSTEMS 


ss Rigid-rigid planar robot arm 
The inertia of each arm will be given from Dj, and 


Doo, aS they are defined in Chapter iL, form—sthe wins eae 
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the second link respectively. Evaluating the expressions of 
Paapeama D55 from the parametric data given in Table 2.1 and 
adding the result to the inertia of the servo motor used at 
each joint (in this particular case the motor inertia J, 1s 
the same for both joints), the effective joint inertias can 
be evaluated. Knowing the effective joint inertias at each 
joint the exact transfer function for each motor will be 
calculated. The inertia of the first arm is also a function 
Seeme angle ©>5 of the second link, solving for the case 


feeee che effective joint inertias become: 


Bog Di1+4m1 = ©9-92+0.024 = 65.944 gr-m-sec’/rad, and 


Mee = D> +Um2 5.12+0.024 = 5.144 gr-m-sec“/rad. 


Substituting the effective inertias calculated above and the 
parametric data for the servo motor, given in Table 4.1, 
into the Equation 4.1 the transfer functions for the two 


Servo motors will be obtained as follows: 


7 9.88 

6, (5) = “37879100 +1) (S/0.016 +1) BO ec) 

ar errand /Velt (4.4) 
2 emi(s/ 2 NOO"' 1) (s/0,204 +1) . 


The open loop Bode plots for the servo motors acting at each 
joint were obtained using the software package 'CONTROLS' 
with the resulted plots are shown in Figures 4.1 and 4.2. 
From the Bode plots it can be observed that the gain curves 
of both servo motors have a slope of -40 db/dec and their 
gain crossover frequencies are i= 9-402 ang) 2>-1.43 vad/sec 
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Figure 4.1 Open loop Bode plot of the servo motor at 
JOINT1 (rigid-rigid, case). 
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Figure 4.2 Open loop Bode plot of the servo motor at 
JOINT2 (rigid-rigid, case). 
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respectively. These results indicate that the electra 
pole can be neglected and the approximation of an ideal 
motor, with its transfer function given as Equation 4.23. 
valid for both systems. In order to have the same gain 
crossover frequency for the ideal motor, the error coeffic- 
i1ent Km must have the value Km; = qc (1=172)3 Therefore 
the error coefficients for the second-order ideal motors 
have the values Km,=0.162 and Km5=2.045 respectively. The 
frequency responses of the ideal motors using the error 
coefficients calculated above are given in Figures 4.3 and 
4.4. 
Pag Rigi@st Pexa bilem sl amciiemerach) Oreancirin 

The general idea of the previous analysis for the 
case of a rigid-rigid planar robot arm is not affecteqm@a, 
changing the second link to be a flexible one. 

The inertia of each arm will now be given from 
Dii1 and Dj99, as they are defined in Chapter J11, "tenia. 
rigid and the flexible link respectively. In this case 
evaluation of Dj11 and Dyj95 is not so simple because in 
their expressions are also involved terms due to the elastic 
motion of the flexible arm. To overcome that problem 
different approaches were used to obtain the frequency 
response of the arm-motor system for each arm. 

For the rigid arm due to the nature of the system 
and observing the quantities involved in the expression of 


the inertia of the arm, D111, the "flexible" terms can be 
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Figure 4.3 Open loop Bode plot for the ideal motor Km,/s¢ 
(Yigid-rigid, Gase). 
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Figure 4.4 Open loop Bode plot for the ideal motor Km>/s¢ 
(rigid-rigid, case). 
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neglected. Therefore the inertia of the arm can be computed 
using the parametric data given at Table 3.3 in Chapter III. 
Peel o5=0 again, and adding the result to the inertia of 
mie, servo motor, Jm,, the effective joint inertia can be 


evaluated: 
Meee 447 tU] = «98. 75+0.024 = 58.774 gr-m-sec? /rad 


Knowing the effective inertia at JOINT1 the exact transfer 
of the motor will be calculated. Substituting the effective 
inertia and the parametric data for the servo motor (given 
Pimemaole 4.1) into Equation 4.1 the transfer function for 
the servo motor acting at JOINT1 is obtained as follows: 


9.88 


ans (a S1comri) (S70n018 1) Hels ISIE (>) 


Gf, (s) 


The open loop Bode plot for this servo motor was obtained 
and the resulteing plot is given in Figure 4.5. The gain 
curve of the servo motor again has a slope of -40 db/dec 
With gain crossover frequency at Nf ,=0.431 rad/sec. In 
order that the ideal motor have the same gain crossover 
Meeqmency, the error coefficient Kmr, must have the value 
Km- ,=2f1°=0.185. The frequency response of the ideal motor 
using the calculated error coefficient is given in Figure 
sO 

In the case of the flexible arm the "flexible" 
terms are Significant and they cannot be neglected. A 
satisfactory approach in terms of the frequency response is 


to uncouple the flexible arm from the rigid arm. With the 
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Figure 4.5 Open loop Bode plot of the servo motor at 
JOINT1 (rigid-flexible, case). 
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Figure 4.6 Open loop Bode plot of the ideal motor Km,/s¢ 
(rigid-flexible, case). 
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flexible arm uncoupled, the transfer function given in 
Ref.1 can be used after appropriate scaling to represent the 
flexible beam with the parametric values of mass, length and 
strength used in this study. The transfer function that 
describes the system, flexible arm and motor, can be 
obtained by combining the two transfer functions and its 
finawerornere. 
585130 (st+1+j330) (st+3.2+3170) (s+9.14+35462) 


s(St+0.3) (S+9100) (S+1.8+35120) (S+4+5215) (s+7.3+3481) 
(4.6) 


Gf, (s)= 


The open loop Bode plot was obtained for the transfer 
function of the flexible arm-motor system, with the plot 
given in Figure 4.7. One can observe that the gain curve 
has a slope that is approximately -40 db/dec, and the gain 
crossover frequency is Nf 5=1.52 rad/sec. In the frequency 
response are also shown three resonant frequencies due to 
the elastic motion of the flexible arm. The magnitude at 
the resonant frequencies is decreasing in amplitude with the 
first resonance occurring at about 120 rad/sec. For the 
case of the ideal motor the response at high frequencies can 
be neglected. In order to have the ideal motor's response 
at the same gain crossover frequency the error coefficient 
Km¢> must have the value Km¢o=Nf12=2.34. The frequéney 
response of the ideal motor using the error coefficient 


calculated above is shown in Figure 4.8. 
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Open loop Bode plot of the arm-motor at JOINT2 
(rigid-flexible, case). 
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Figure 4.8 Open loop Bode plot of the ideal motor Km5/s¢ 
(rigid-flexible, case). 


46 


V. VELOCITY CURVE FOLLOWER CONTROL SCHEME 


A. BACKGROUND 

A commonly used modification of a bang-bang controller 
is the "curve following" servo [{Ref.14]}. The "curve 
following" control scheme usually involves three modes of 
operation in following a step position command. There are 
an initial full acceleration mode, a curve following mode 
and a terminal linear servo mode. The nice feature of this 
control scheme is that the amplifiers used are intentionally 
being driven into saturation resulting in fast response and 
taking full advantage of the available power in the motor, 
which is being driven with full forward or full reverse 
power. This is the main advantage compared to linear 
controllers where saturation of the amplifiers must be 
avoided because it renders the controller ineffective. 
Other advantages of this control scheme are its implement- 
ation on a digital machine and the adaptive capabilities 


which were discussed at the introduction in Chapter I. 


I . DESCRIPTION OF THE VELOCITY CURVE FOLLOW SYSTEM 

The velocity curve following control scheme is illustr- 
ated in Figure 5.1. The control scheme that will be used 
has two modes of operation in following a step input 
command. It can be shown that the commanded input does not 


have to be a step. Actually any input command (of arbitrary 
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The velocity curve follow system. 


Figure 5.1 
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Shape) can be used with the proposed control scheme. 

Initially the system gets into full acceleration until 
the designed curve is reached, at which point the system 
follows the curve. The velocity curve follow control scheme 
is therefore a nonlinear control scheme and practically it 
1S a modification of a bang-bang controller. 

When an input is applied to the system, the resulting 
error Signal, E, will enter the curve as the "distance to 


go" producing as output the corresponding velocity ordinate 


of the curve, X. This velocity Gf becomes the input of the 
velocity loop. The "Saturation Amplifier", saturates and a 
full forward signal is applied to the motor. As the 


position error signal decreases, the output from the curve 
1s reduced and the velocity feedback signal, Ke, increases 
until the velocity error, XE, becomes zero. Zero velocity 
error means that the acceleration trajectory crosses the 
designed curve. From that point the velocity error reverses 
Sign, causing the input voltage to the motor to reverse, and 


the system decelerates following the curve down until it 


reaches the final position. 


oF DESIGN OF THE CURVE 

The curve used in any curve follow control scheme must 
have a shape that fits the requirements for the specific 
system and the application of that system. 


For the purpose of this study the curve will have a 
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parabolic shape. The equations describing this curve can be 


derived from the equations of the ideal motor as follows: 


eI (Sam 

ows | CURL Eas GR SS el Co) (5.2) 

ec 2) © at ee erereliay (sae) 
2 m sat 


Solving Equation 5.2 for t and substituting its expression 
into Equation 5.3, after some algebraic manipulations and 
with the initial conditions C(0)=0 and C(0)=0, the following 


equation is obtained: 


ne, 
<u eee Ge 
m sat 


For deceleration of the system from initial conditions, with 


the input R=0, then: 


C= -E (5.5) 


C = -E (5.6) 


Combining Equations’ 5e4) 5.5 and 5 so unt iemm = 


55 (5.7) 


where 


218) 


Therefore the output of the curve that represents the 
commanded velocity can be generated at any instant of time 
from the multiplication of the square root of the position 
error by the defined constant factor A. This constant 
factor will be initially calculated from the specific 
parameters K, and Vest and its value stored in the memory of 
Emeragital computer. The gain constant of the second order 
fecdel, K,, 18 determined by the actuator parameters and the 
effective inertia seen by the actuator and is_' updated 
through the adaptive algorithm. The initial values for 
these gain constants have been derived in Chapter IV for two 
different cases of a planar robot arm with two links, the 
rigid-rigid and the rigid-flexible. 

The saturation limits, Vear, of the amplifier are 
determined by the available servo motor parameters, the 
mechanical design of the arm of the manipulator and the 
working conditions. The gain parameter Ky must have a 
relatively large value in order to saturate the amplifier 
even for small commanded velocity signals. 

The gain parameter Kj, used to reshape the curve as a 
weight factor cf the commanded velocity signal, and the 
feedback gain K will be used in the velocity curve follow 
model in order to give best system performance and suitable 
results for each specific problem. The calculations of the 


values of K and K, will be based on the simulation results. 
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D. SIMULATION STUDIES OF THE CONTROL SCHEME MODEL 

To demonstrate the good performance of the basic model, 
shown in Figure 5.1, and the ability of the velocity curve 
follow control scheme to follow the designed curve, the 
model was simulated using DSL/VS. The DSL/VS simulation 
program is listed in Appendix E. 

The basic model was simulated with different values 
corresponding to each link of the planar robot arm, for both 
cases the rigid-rigid and the rigid-flexible. The resulted 


four sets of parameters are given in Table 5.1. 


TABLE 5.1 RESULTED PARAMETERS FROM THE SIMULATION STUDY 
OF THE BASIC MODEL. 


Rigid-Rigid Rigid-Flexible 


- 62 waa 2.045 rad 


= +300 V = +150 V 


-185 rad/V _340 “rag 


= +300 V = +150 V 





To guarantee the saturation of the amplifier the value 
Ky=10,000 was chosen to be used at the simulation studies 
for all the different cases. 

From the simulation studies the appropriate gain values 


were obtained using trial and error. The best value for the 


D4 


feedback gain, in all cases, was found to be K=1. For the 
Senstant weight factor K,, the values 0.8 and 1 gave the 
best system performance when used with the parameters 
corresponding to the first and the second link respectively. 

Simulating the basic model for a commanded input R=1 
rad by using the calculated parametric values of the rigid- 
rigid planar robot arm, the step response and the phase 
plane trajectories are given in Figures 5.2 and 5.3. Using 
the parametric values (extracted from the rigid-flexible 
planar robot arm) the corresponding plots are given in 
megures 5.4 and 5.5. 

From the phase plane, where the trajectories of the 
angular velocity C and of the commanded velocity X versus 
the angular position C are given, one can observe that the 
angular velocity increases with constant acceleration until 
the curve is reached. From that point the angular velocity 
follows the designed curve until the desired position is 
reached. Reaching the final position the system stops with 
no oscillations. 

The step responses demonstrate good performance of this 
basic model with fast response and with no overshoots, even 


for this relatively large commanded input signal. 


i < THE ADAPTIVE MODEL 
The block diagram of the adaptive model that will be 


used in controlling the two links planar robot arm (at both 
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Figure 5.2 Basic model using data corresponding to LINK1 
(rigid-rigid case). 
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Figure 5.4 Basic model using data corresponding to LINK1 
(rigid-flexible case). 
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Figure 5.5 Basic model using data corresponding to LINK2 
(rigid-flexible case). 
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cases) is illustrated in Figure 5.6. The output signal from 
the saturating amplifier of the adaptive model is common to 
both the second order ideal motor and to the actual system 
that 1s a combination of the real motor and the arm of the 
manipulator. Therefore the control scheme forces the actual 
system to follow the second order model of the ideal motor 
which in turn is adaptive in nature. 

The angle, TH, of the manipulator's arm is measured at 
specified time intervals and the resulting value is used in 
the adaptive algorithm to update the states and the gain 
constant of the second order model. Figure 5.6 shows that 
the entire control scheme and the adaptive algorithm can be 
implemented in a digital computer and the only hardware 
requirement for the proposed system will be the device that 
measures the angle of the arm. The gain constant K, Gigene 
second order model has to be adjustable in order to account 
for the inertia reflected back to the joint due to the 
motion of the arm. The adaptation algorithm for Keine 
satisfy the following two conditions: 

1) The calculations must be accurate to allow the 

states of the second order model to approximate the 

trajectory of the actual system. 

2) The required calculations must be kept simple 

because K, must be updated in minimum time and the 


algorithm has to be easily programmed in a computer. 
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Block diagram of the adaptive model. 


Figure 5.6 
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The method described in Ref 15 satisfies the above 
stated conditions and will be used in this’ analysis. 
Solving Equation 5.3 for K,, with zero initial conditaen 


the following expression was obtained: 


2c 
K = ———_— (5.8) 


For discrete time intervals the time t will be replaced by 
the product NT where T is the sampling interval and N the 
number of sampling intervals. By also letting C=TH Equation 


5.8 obtains thewsoun. 


2 Te 


2 — ea oa = (S235) 
m 2 
ae (NT) 


Equation 5.9 for Ky, is valid only for Constant ace 
ation of the system. Therefore the gain K, will be updated 
during the full acceleration mode and until the velocity of 
the actual motor reaches the velocity curve. During the 
curve following mode K, will remain unchanged. 

To update the states of the second order model the 
adaptive algorithm requires the angular position and the 
angular velocity of the actual system. The actual angular 
velocity of the system cannot be used and therefore must be 
estimated from the measured angular position of the system. 
Therefore the estimation of the angular velocity will be 
obtained as the derivative of the sampled angular position, 
that in discrete representation is: 
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TH (N) a 2 = TH(N-1) (5.19) 


where TH(N-1) is the last estimation of the angular velocity 


given from: 


meN—-1) = —u* ae el (5.11) 


Equation 5.10 requires the storage of the last angular 
position and the last estimated angular velocity. From 
Equation 5.11 it is clear that the angular velocity can be 
estimated after two samples of angular position are taken. 
Equation 5.10 is not self correcting if the system switches 
from full acceleration to the curve following mode, until 
two new samples of the angular position are taken after the 
switching. To eliminate this problem, the switching time 
has to be detected and the value of the velocity of the 
second order model at that time must be stored as TH(N-1), 
in order to be used at the next calculation. 

The storage of the data and the required calculations 
as given in Equations 5.10 and 5.11, and also the required 
checks can be easily programmed in a microprocessor. 

This adaptive model will be used through the end of 
this thesis at the simulations of the two links planar robot 


arm, for both the rigid-rigid and the rigid-flexible cases. 
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VI. SIMULATION OF THE ADAPTIVE MODEL 


A. INTRODUCTION 

In this Chapter simulation results will be obtained for 
the two cases, the rigid-rigid and the rigid-flexible, of a 
two links planar robot arm. The proposed velocity curve 
follow adaptive control scheme will be investigated for the 
case of the rigid-flexible two links planar robot arm in 
order to examine how well it can correspond to the control 
requirements of the model. The simulation results of each 
model will be examined in order to obtain the corresponding 
performance. Finally the performance of the two different 
models will be compared as well as the equations of motion 
derived for each model, as given in Chapters II and III 


respectively. 


B. COMPARISON OF THE EQUATIONS OF MOTION 

The equations of motion that describe the two models 
were given as Equations 2.2 and 2.3 in Chapter II for the 
case of the two rigid links, and as Equations 3.9 - 3.12 in 
Chapter III for the case of the rigid-flexible two links 
Dilanas: OD Or Farm. 

Comparing the two sets of equations one can observe 
that the second order differential equations obtained by 
evaluating Lagrange's equation with respect to the general- 


ized coordinates 8, and 65, are exactly the same for been 
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cases except that some additional terms are included in the 
first two equations of motion for the rigid-flexible planar 
robot arm due to the flexibility of the second link. The 
number of additional terms is proportional to the number of 
assumed-modes used to express the elastic motion of the 
flexible beam. The other terms are identical because they 
represent the same rigid motion with the elastic motion 
Superimposed this rigid motion, for the case of the rigid- 
flexible planar robot arm. 

In the case of the rigid-flexible planar robot arm n 
additional second order differential equations will be 
obtained, by evaluating Lagrange's equation for n generali- 
Meemecoordinates g; (1=1,2,...,n), in order to model the 
elastic displacement of the flexible link using n assumed- 


modes. 


Cs PLANNING THE SIMULATION STUDIES 

The sample motion used to investigate the performance 
of the two links planar robot arm iS depicted in Figure 6.1. 
The same sample motion was used for both, rigid-rigid and 
rigid-flexible, combinations of the two links planar robot 
arm. This sample motion was decided in order to remove as 
many of the nonlinearities as possible and to investigate 
the system behavior for possible overloading conditions. 

A step input with amplitude 1.0 rad was used to drive 


the two motors acting on JOINT1 and JOINT2 respectively. 
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Figure 6.1 Sample motion of the planar robot arm. 
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In order to have a more complete understanding of the 
system's performance the sample motion of the two links 
planar robot arm in the simulation studies will considered 
with and without load in both gravitational and gravity- 
free environments. The case where the sample motion will be 
completed in two successive steps, by first moving only the 
first link and, when its final position is reached, then 
moving the second link, will be also investigated in the 
Simulation studies. 

First, a complete set of simulation results will be 
obtained for the case of the two rigid links planar robot 
arm, with the phase plane and the step response plots given 
for the two generalized coordinates 6, and 65 corresponding 
to the angular position of LINK1 and LINK2 respectively. 

Similar studies will investigate the performance of the 
rigid-flexible planar robot arm, with plots giving the end- 
point displacement as well as the phase plane and the step 
@eopense plots for each of the two angles ©, and 95 of the 


mroothetical rigid motion. 


‘DI SIMULATION OF THE RIGID-RIGID PLANAR ROBOT ARM. 

The simulation results for the two rigid links planar 
robot arm are given in Figures 6.2 - 6.13. 

Figures 6.2 and 6.3 are the phase plane and the step 
response respectively of the unloaded arm in a gravitational 


environment. Considering a load, equal to the mass of the 
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Rigid-rigid planar robot arm, Phase plane. 
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Figure 6.3 Rigid-rigid planar robot arm, Step response. 
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Rigid-rigid planar robot arm, Phase plane 
(arm loaded). 
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Figure 6.5 Rigid-rigid planar robot arm, Step response 
(arm loaded). 
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Figure 6.6 Rigid-rigid planar robot arm, Phase plane 
when moving only LINK1 (arm loaded). 
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Figure 6.7 Rigid-rigid planar robot arm, Step response 
when moving only LINK1 (arm loaded). 
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Rigid-rigid planar robot arm, Phase plane 


when moving only LINK2 (arm loaded). 
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Figure 6.9 Rigid-rigid planar robot arm, Step response 
when moving only LINK2 (arm loaded). 


13 


24 


20 





THAD. (RAD/SEC) _ 


“0.41 0.0 Oo. G2 0.3 %O.4 O85 0.6 G.7 OS 8.9 1.0 . 1.1 
TH2 (RAD) 





0.9 1.1 1.3 


-0.1 0.4 0.3 0 


5 0.7 
THY (RAO) 
| PHRASE PLANE ([RIGID-RIGIO PLANAR ROBOT ARM) 


Figure 6.10 Rigid-rigid planar robot arm, Phase plane 
(gravitational-free environment). 
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Figure 6.11 Rigid-rigid planar robot arm, Step response 
(gravitational-free environment). 
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Figure 6.12 Rigid-rigid planar robot arm, Phase plane 
(arm loaded, not including the gravitational 
forces) 
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Figure 6.13 Rigid-rigid planar robot arm, Step response 
(arm loaded,not including the gravitational 


forces). 
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second arm, to be carried from the manipulator the resulting 
phase plane and step response plots are shown in Figures 6.4 
and 6.5 respectively. To complete the sample motion in two 
successive steps, LINK1 is moved first with the resulting 
phase plane and step response plots shown in Figures 6.6 and 
6.7 and then LINK2 is moved having the resulting phase plane 
and step response plots given in Figures 6.8 and 6.9, 
respectively. When the sample motion of the two rigid links 
planar robot arm is considered in a gravitational-free 
environment, the resulting plots when the manipulator is 
unloaded are given in Figures 6.10 and 6.11. Figures 6.12 
and 6.13 are the plots corresponding to a loaded manipulator 
in a gravitational-free environment. In the gravitational- 
free environment cases small overshoots occured in the 
response of the angular position for both links, especially 
with the manipulator loaded. The reason for these effects 
is that the motors were selected with parametric values to 
Satisfy a gravitational environment. Therefore the motors 
overdrive when no gravitational forces are included in the 
equations of motion. The two links accelerate past the 
deceleration curve which then cannot slow down the system 
enough to stop at the desired position. This causes the 
small overshoots to appear. The step response of the system 
for any of the above situations confirm that the use of the 
velocity curve follow as the control scheme of a two rigid 


links robot arm results to a near minimum time response. 
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ite. SIMULATION OF THE RIGID-FLEXIBLE PLANAR ROBOT ARM. 

The model of the rigid-flexible planar robot arm will 
be tested using the same sample motion. For the particular 
Situation this sample motion represents the hypothetical 
rigid motion with the elastic motion superposed on this 
motion. For the case of the rigid-flexible planar robot arm 
in the simulation results the plots for the flexible motion 
of the end-point of the flexible beam will be also obtained. 

Figures 6.14, 6.15 and 6.16 illustrate the phase plane, 
step response and elastic motion of the end-point respec- 
tively for the case of the rigid-flexible planar robot arm 
in a gravitational environment with the manipulator not 
carrying any load. The plots demonstrate that the proposed 
velocity curve follow control scheme is fully applicable 
with the system of a planar robot arm having a rigid first 
link and a flexible second link. The resulting plots 
indicate a good overall system performance with the hypo- 
thetical rigid motion being completed in near minimum time. 
The elastic motion of the flexible beam has no effect in the 
response of the first link, that actually is smoother due to 


a lighter second link as compared to the two rigid links 


case. The motion produces a very small overshoot, less then 
2%, in the response of the flexible link. The response of 


the overall system is of course much slower due to the 
settling time required for the elastic motion of the 


flexible beam. 
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Figure 6.14 Rigid-flexible planar robot arm, Phase plane. 
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Figure 6.15 Rigid-flexible planar robot arm, Step 
response. 
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Figure 6.16 Rigid-flexible planar robot arm, Elastic 
motion of the end-point. 
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2.4 


Due to the flexible motion of the end-point this time 
is approximately 1.5 sec, which is about 5 times more then 
the required time for the rigid motion. Figure 6.16 shows 
that the end-point is displayed in a negative direction with 
respect to the center line of an equivalent rigid arm. This 
is due to the bending of the flexible arm as it is ac- 
celerated. No other vibrations occur in the response of 
the flexible displacement. 

When a load is carried by the manipulator the simula- 
tion results are given in Figures 6.16, 6.17 and 6.18. The 
load carried by the manipulator is equal to the load used in 
the simulation studies of the two rigid links planar robot 
arm, resulting a load that is approximately 50% more then 
the weight of the flexible link. Therefore in the case of 
the rigid-flexible planar robot arm the payload will be 
increased. The resulting phase plane and step response 
plots indicate some vibration modes acting on the system due 
to the increased weight of the flexible beam. The effects 
of these vibrations are more apparent in the response of the 
flexible beam where they cause some overshoots to occur. 
Because of the nature of the system, the overshoots in the 
response of the flexible beam are not constant in frequency 
and amplitude. The reason for this is the several vibration 
modes, due to the elastic motion, acting on the system and 
the coupling effects of the two arms during the hypothetical 


rigid motion of the system. 
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Figure 6.17 Rigid-flexible planar robot arm, Phase plane 
(arm loaded). 
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Figure 6.18 Rigid-flexible planar robot arm, Step 
response (arm loaded). 
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Figure 6.19 Rigid-flexible planar robot arm, Elastic 
motion of the end-point (arm loaded). 
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These coupling effects are also indicated in the 
response of the rigid arm, where some vibrations exist 
having small amplitudes. The vibrations of the flexible arm 
are coupled into the rigid arm and increase its settling 
time. When the flexible arm is loaded the settling time of 
the rigid arm is about 1.0 sec, which is greater then the 
settling time for an unloaded arm by about a factor of 
three. This is also the required settling time for the 
hypothetical rigid motion of the flexible link. The actual 
settling time of the flexible link is given by the required 
settling time of the end-point. Thus the settling time of 
the flexible arm is also increased by the load, which causes 
its oscillation to last about 2.1 sec. The load also tends 
to cause the end-point to overshoot the desired position. 
The total response time of the end-point is 0.6 sec longer 
when the arm is loaded. The additional time requirement may 
be acceptable related to the incresed weight of the flexible 
arm due to the load. 

For the sample motion to be completed in successive 
steps the requested motion for only the rigid arm will be 
first completed, followed by the movement of the flexible 
beam. The same results will be obtained by reversing the 
order of the successive steps, first moving the flexible arm 
and when its motion is completed moving the rigid arm. The 
resulting plots are illustrated in Figures 6.20, 6.21 and 


6.22 for the phase plane, the step response and the flexible 
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Figure 6.20 Rigid-flexible planar robot arm, Phase plane 


moving only the rigid link (arm loaded). 
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Figure 6.21 Rigid-flexible planar robot arm, Step 
response moving only the rigid link 
(arm loaded). 
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Figure 6.22 Rigid-flexible planar robot arm, End-point 
displacement, moving the rigid link 
(arm loaded). 


90 


end-point displacement respectively when moving the rigid 
arm. For the motion of the flexible arm the respective 
plots will be shown in Figures 6.23, 6.24 and 6.25. The 
required time to complete the sample motion, by adding the 
time that is required to complete each motion of the 
Successive steps, 1S approximately 4.0 sec. Therefore the 
settling time for the sample motion, when using the method 
of the successive steps, will be twice the required settling 
time of the previous simulations. If the time is not the 
only important requirement, then the use of the method 
described above will give some advantages in the performance 
of the system. These advantages can be shown in the phase 
plane and the step response plots of the two motions. From 
these plots one can observe that the responses of the rigid 
arm and the flexible arm have less vibration and insignifi- 
cant coupling effects. Thus, the resulting response for the 
flexible arm has much smaller overshoot and is close to a 
linear system type response. That was expected from the 
Simulation results for a planar robot arm having only one 
flexible link, as was illustrated at Figures 3.5 and 3.6 in 
Saapter IIil. 

When the rigid-flexible planar robot arm motion is to 
be performed in a gravitational-free environment (i.e., 
space applications) the simulation results giving the phase 
plane, the step response and the flexible displacement of 


the end-point will be illustrated for the unloaded planar 
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Rigid-flexible planar robot arm, Phase plane 


moving only the flexible link (arm loaded). 
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Figure 6.24 Rigid-flexible planar robot arm, Step 


response, moving only the flexible link 
(arm loaded). 
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Figure 6.25 Rigid-flexible planar robot arm, End-point 
displacement, moving the loaded flexible 
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robor arm in Figures 6.26, 6.27 and 6.28 and for the loaded 
Eeamar robot arm in Figures 6.29, 6.31 and 6.31. 

In the case of a gravity-free environment the response 
for the hypothetical rigid motion of the unloaded rigid- 
flexible planar robot arm, as shown at the phase plane 
(Fig. 6.26) and the step response (Fig. 6.27), are almost 
identical to the results obtained for the two rigid links 
planar robot arm. The required settling time of the overall 
motion will be about 0.8 sec due to the required settling 
time for the end-point flexible displacement. When the arm 
1s loaded the size of the overshoots occurring in the system 
becomes larger and the required settling time for the 
overall motion increases to about 1.9 sec, (that is about 
the required settling time of the unloaded manipulator 
moving in a gravitational environment). 

Therefore in a gravity-free environment the rigid- 
flexible two links planar robot arm gave very good performa- 


nce. 


Pe. COMPARING THE SIMULATION RESULTS 

Many observations can be made by comparing the obtained 
Simulation results for the rigid-flexible and the two rigid 
links planar robot arms. 

The results for the required settling time of the 
hypothetical rigid motion of the rigid-flexible robot arm 


are very close to the near minimum time positioning of the 
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Figure 6.26 


Rigid-flexible planar robot arm, 
(gravitational-free environment). 
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Figure 6.27 Rigid-flexible planar robot arm, Step 


response (gravitational-free environment). 
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Figure 6.28 Rigid-flexible planar robot arm, End=pommt 
displacement (gravity-free environment). 
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Rigid-flexible planar robot arm, Phase plane 


(arm loaded-not including gravitational 


forces). 
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Figure 6.30 Rigid-flexible planar robot arm, Step 
response (arm loaded - no gravitational 
forces included). 
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Figure 6.31 Rigid-flexible planar robot arm, End-point 


displacement (arm loaded - no gravitational 
forces included). 
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EWO (iGagid stlamics = The hypothetical rigid motion of the 
rigid-flexible robot arm resulted in overshoots and vibrati- 
ons, that are highly nonlinear in amplitude and in frequen- 
Cy. The reason for the overshoots is that the system 
presents four natural frequencies, two rigid and two 
flexible as the model takes into account only two modes of 
the flexible beam, combined with the coupling effects 
between the two links. By lowering these frequencies when 
increasing the load of the flexible link these effects are 
more pronounced. The stated nonlinearity in the system's 
response can be observed from the shapes of the curves for 
both the phase plane and the step response plots. 

From the plots of the elastic motion of the system, for 
the end-point displacement, it can be seen that accurate 
results require a long settling time. Another interesting 
point is that the end-point of the manipulator bounces back 
and forth from its final position slowly but not many times. 
That indicates a good control of the flexible components 
from the adaptive model. 

In the case where the sample motion, or any desired 
motion, will be completed in successive steps by moving the 
links one at a time, the system's performance indicates 
better results with respect to the accuracy and the introdu- 
ced vibrations. In this case the required settling time for 
the completion of the sample motion will be approximately 


twice the time required when the two links are moving 


LOZ 


Simultaneously. Therefore once more a decision must be made 
based on the requirements of the specific application. 

For the case where no gravitational forces are included 
in the environment, the rigid-flexible robot arm has a 
better performance, not very different from the one obtained 
for the two rigid links. Because the performances are not 
very different, the other advantages of the flexible 
manipulator make its use more advantageous for applications 


in a gravity-free environment, such as space applications. 
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Vo CONCLUSION AREAS FOR FURTHER STUDY 


As a result of the research conducted in this thesis, 
the control of the rigid-flexible, two links planar robot 
arm, uSing the curve following system, appears not only 
possible but resulted in a relatively good predicted 
performance of the system. 

The sample motion used in testing the adaptive system 
introduced relatively large inputs for both links of the 
manipulator in order to examine the system under large 
parameter variations. 

The simulation plots indicate that the system provided 
very good steady-state accuracy (of the order 10E-3) for eae 
elastic motion of the flexible link under all tested 
conditions. The steady-state accuracy was independent of 
the load of the flexible link, but not the settling time of 
the elastic motion. The required settling time of the 
elastic motion for all cases was many times greater than the 
required settling time of the hypothetical rigid motion. 
Which was approximately equal to the near minimum time 
positioning of the two rigid links planar robot arm. 

In the case of a loaded arm increased overshoots with 


more vibration modes were introduced in the angular position 


of the arm. This problem was partially alleviated by 
completing the motion in successive steps, i.e., by moving 
the rigid and the flexible links sequentially. This 
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solution results in an overall increase of the required 
settling time and the whole situation is a trade-off between 
time and the amount of oscillation. 

It was also observed that for the case of the direct 
drive arm that was used as the model, the effects of the 
disturbance torques caused by the elastic motion and the 
coupling inertia between the two links as well as the 
centripetal, coriolis and gravitational forces acting on the 
robot arm, are larger. Therefore the servo motor must apply 
larger torques which implies high torque constant and high 
armature current capabilities. Due to the lighter structure 
of the flexible link the torque requirements (for both 
motors) are smaller than the requirements in the case of a 
two rigid links planar robot arm. Therefore the lighter 
rigid-flexible planar robot arm results in less’ power 
consumption, that also means use of smaller actuators. 

Combining the above stated main advantage with the 
resulting end-point accuracy (from the simulation of the 
adaptive model) the rigid-flexible manipulator may be an 
attractive solution for many applications. 

Compared with a two rigid links planar robot arm, the 
rigid-flexible planar robot arm may be preferable in many 
applications especially when time is not the main require- 
ment and also in gravity-free environment applications, such 


aS space applications. 
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An area for further study arises when the feasibility 
of controlling two flexible links with the proposed adaptive 
computer simulation model is to be investigated. 

Modelling the manipulator both links were assumed to be 
massless. Another area for further study arises when two 
links having their masses distributed along their lengths 
are used to build a robot arm. 

Finally a very interesting area for further study will 
be the use of the same curve following method as the 
adaptive control scheme but with curve reshaping through 


the adaptive algorithm in order to obtain better system 


performance. 
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APPENDIX __A 


DERIVATION OF THE LAGRANGIAN EOUATIONS FOR THE 


TWO RIGID LINKS PLANAR ROBOT ARM 


For the sake of the analysis the configuration of the 


system for the two rigid links planar robot arm will be 


repeated as Figure A.1l. 


Gravitational Force 
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Figure A.1 Planial =5CbCepamiiswithne two rigid links. 
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For this particular system the generalized coordinates 
are ©, and @5, and the ‘generalized storees ence 
defined in Chapter II. To form the Lagrangian funcricnee 
the kinetic and potential energies of the system must 
derived in terms of the generalized coordinates. The 
kinetic energy of any multi-link robot arm system can be 
obtained from the kinetic energies of the individual links, 
therefore, for the two links robot arm system, the kinetic 
energy T will be the sum of the kinetic energies T, and Tp» 
of LINK1 and LINK2 respectively. The kinetic energlcomaaay 


and T>, will be given as: 


ao! Io. 
qT, 7 oon m,1,9, (A.1) 
., Lo 2 
T, = om m. (x5+Y>) (Ages) 
By coordinates transformation: 
X= 1, cose, + 1,cos(0,+0.) (A.3) 
Yo= 1,s1ino,+ 1,sin(0,+0,) (A. 4) 


Taking the derivatives of the Equations A.3 and A.4 then: 


x, = ~1,9,s1ino,- 1, (9,+0.,)sin(©,+9,) (A. 33 


V5 — 1,6 ,cose;* 15 (6) emmieeaicr sa (A.6) 


Je 2) 2) 


Substituting Equations A.5 and A.6 into Equation A.2, after 
Simple algebraic manipulations, the kinetic energy for the 


second link is given by the following equation: 
108 


rs oe eee — 
i pH [lao (6, +20,e,+0 >) +21, 1, (8, 4+6,9,) cose (Re) 


5] 


Therefore the kinetic energy of the system will be given as: 


ei 5 oS) “5 oe “5 
T = =e ((m,+m.,)1, Qo, tm1., (9, +20,9,+8,)] 
(A.8) 
‘oO 
+ mo1j,1,(9, +9,9.) cose, 


The total potential energy of the system can be 
computed by following the same procedure from the potential 


energies of the individual links, given as: 


V 


1 — ™,9Y, = m,gl,sino, (A.9) 
Vv. = ™,9Y, = mog{1,sine,+1,sin(6,+9,) ] (A.10) 
Therefore the total potential energy is: 
V= VitV, = (m,+m,)gl,sin@,+m,gl.,sin(6,+0,) (A.11) 


Thus the Lagrangian function, L= T - V, for the system 
of the two rigid links planar robot arm will be obtained 
from Equations A.8 and A.11. After algebraic manipulations 


the Lagrangian function obtains the final form: 


Re i 2 ae. 
aie) )O, 45 5 (m,1,+J3,)9, 


i Zee : 2 Ke 
ire m, (1, +1,+21,1,cose®,)0, +m, (1,+1,1,cose,)9,9, (A.12) 


[(m,+m.,)1,sino0,+tm,1,sin(6,+9.,)]g 


From the above derived Lagrangian function L, the partial 


derivatives of L with respect the generalized coordinates 9} 


TOS 


and @5 and their rate of change 6, and 65 will give the 


following results: 











50, = -(m,+m,)gl,cos®, - m,gl,cos(6,+é,) (A.13) 
Ole 2 : PI : 
“ie (m,1,+J,)9, f m. (1, +1,t+21,1,cose,) 9, 
68, (A.14) 
5 : 
“ m, (1,+1,1,cos6,)9, 
Ge oe 2 2 2 ~ 
at ( .) = (m,1, td, +m, 1) t+m,1,+2m,1,1,cose,)9, 
60, 
+ (m,1$+m,1,1,cos®,)9, (A.15) 
| ° « , bd 2 
(2m,1,1,sin9.,)9°,9.,- (m,1,1,sin0,)°, 
are =(m> ale san© e" = elles iiae 6 g 
60. 2 eee Zima Zale 2a lLewe 
(A.16) 
~m.,gl.,cos (6, +0.) 
él _ 2 : 2 : 
— 5 nie aa i eoseicy (A.17) 
60. 
(s eae ee ae 2 2 an 
ARE (aa) (m,1,+J3,)°, +(m,1l,t+m,1,1,cose®,)9, 
60., (A.18) 


= m51,1,sino. 0,9. 


A set of two nonlinear second order differential 


equations will then be obtained by direct substitution of 
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iemehaquations A.13, A.15, A.16 and A.18 into the formula for 


the Lagrange's equations: 








is = Q. i=1,2 (A.19) 


with the generalized forces to be, in this particular case, 
Q,=-l, and Q9=ln. The derived pair of the nonlinear second 
order differential equations was given in Chapter II of this 


thesis, as a result of this analysis. 
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APPENDIX B 


DERIVATION OF THE MODEL FOR A PLANAR ROBOT ARM HAVING 


ONE FLEXIBLE LINK USING THE ASSUMED-MODES METHOD 


Bil. GENERAL REMARKS 

In this Appendix, the derivation of the mathematical 
models for a planar robot arm having one flexible link will 
be given, with the flexibility being approximated using the 
assumed-modes method. The set of the second order differ- 
ential equations of motion that describe that system will be 
derived using the Lagrangian dynamics approach. 

The Lagrangian function can be computed as L=T-V, where 
T and V are the kinetic and the potential energies of the 
system respectively. Therefore the Lagrangian function will 
be derived similar to the method followed in the case of the 
flexible second link of the planar robot arm, as will he 
given in Appendix D. Expressing the Lagrangian function in 
terms of the flexible displacement up the following equation 


are obtained: 


uJ Zee Re 2 a 
= — } + = 
L 5 {ml oO mo Us muy |] 6 mlou, 
o (Bay) 
; 1 2 
= g(mlSING? MU cose) = = re) 
Z : pan 
1=1 
where n= 1, 2 or 3. 


With the above derived Lagrangian function L, the set of the 


differential equations that describe that system can be 


Ly 2 


obtained by forming the Lagrange's equation with respect the 
generalized coordinates. For this system the generalized 
Geerdinates are defined to be © and gj (i=1, 2 or 3). Thus 
sets of two, three and four nonlinear second order differen- 
tial equations will be obtained when the numbers of the 
assumed modes used to approximate the flexibility are n=1,2 
or 3, respectively. The differential equations will be 


obtained by forming the Lagrangian equation, as is given 


below: 
a 6L Eos = me 
at fac) ~éq, = Q; Mie a ae (B.2) 
oq. 


B2. EXPRESSING THE FLEXIBILITY WITH ONE ASSUMED-MODE 
For the case in which the flexible displacement will be 


expressed uSing one assumed mode then: 
Up = £191 (B.3) 


Replacing the above expression for the flexible displacement 


the Lagrangian function will obtain the form: 


L = a (mle 


2 2 2 


+ mo )?+ m(£,.9,) 7] 


(T1294 


: ; 1 , 
=P mlO(f,,9,) oe KW594 (B.4) 


eg (ml Samoa sin £ )cos@] 


1E91 


Forming the Lagrangian equation of the above given 
Lagrangian function with respect the generalized coordinate 


a cnen;: 


IES 


6L 








co m= 9 [ml6@cosée - msinot, .g, | (Baa) 
5 i ae ; ° 2 
as ml oO tmlf5.9, +m0(f,.9),) (B.6) 
60 
a Sees: cs ah 5 ee 5 
at ( y)=m1 0 tm1f, 294 +mO (£559) + 2m0 9,(f,759,) GBe7,) 


The same approach with respect the generalized coord- 


inate gj resules een. 








Obes. s-: aie ee i 7 
5g, = mo tind KW 9, gmf, ,cos® (B.8) 
eee 20) : 
_ mf559,+ mlofi. (B93) 
od, 
dq Lae ae _ 
ae ( )= mf 559, 42 milf, ,° (B.10) 
oq, 


Combining Equations B.5 and B.7 the first nonlinear second 
order differential equation can be produced. The second 
nonlinear differential equation will be derived from the 
Equations B.8 and B.10. The final form of the differential 
equations that describe the system when one assumed mode is 
to be used to describe the flexibility of the arm will be 


given as follows: 


r= D C) 


WW”) Pes) 


“oe 9) ane (B.11) 


S11) 9 ops a Socks) 


5 oe DoD 
Di4i = jib mf5 59, 
Ding = MIip 
D = omf- 

m2 ie 
D, = g[ml9O cosoO ~mf,_9,S1n0] 
Doan 7 Mie 
Dooo = “lip 

D = ae 

p11 1E%1 
D. = gmf, ,coso -- KW59, 

lbs 7 a 

KW, = EI | = (es), (a) Cb 


Equations B.11 and B.12 are the mathematical model used 
in the analysis of the flexible arm, in Chapter III, when 
the flexible displacement is to be expressed with one 


assumed-mode. 


B3. EXPRESSING THE FLEXIBILITY WITH TWO ASSUMED-MODES 
Having the flexible displacement, Uup,, being expressed 
with two assumed-modes then: 
Up = f1n91 + f2Rd2 (B.13) 


By replacing the derived expression for the flexible 


displacement the Lagrangian function will achieve the form: 


ase PLS) ce 2 ° i 2 
i —a imi O +me (£559) tt5p9>) tm(f£,,9,+f,,9,) ] 


IAs: 


. : . 1 , 5 
+ mlO(f,,9,+f,,9,) — 5 (KW, g,+KW.g.) (B.14) 


=—SGimlcine nar ari )cos9] 


1E21  ~2E22 


In these case the generalized coordinates are 9, g, and 
G>- Therefore a set of three second order differential 
equations will be obtained by following the same procedure 
aS was illustrated in the case of the one assumed-mode. By 
taking partial derivatives of the Lagrangian function with 
respect each generalized coordinate and their corresponding 
velocities and differentiate with respect the time the 


following equations will be obtained: 


P= D8 FP 9991 1013392 797729 Fy 491139 Jp TD, = (B-15) 
: . oe at oS 
0 = D541 4D 95091 1923392 7Pa1119 792 Wee 2) 
- e e e e e e wee 
0 = D371 19 493509, 1933395 1931119 193 Seon) 
where 
2 Do 8 23 
= + 
Diag > mfi59, + MEopIn + emf, pt 559192 
Ding = Mf, 
D133 = mitos 
D SS oyaiee ee ake 
112 1E91 1E 2E22 
2 2 
Di33 7 2mMf5p95t emf pt op9) 
D, = gmlOcoso - gm(f159,tt,,9,) sino 
Doi, = MIE 


LG 


ae 
Doon = ™ETp 
D533 - ™liploe 
Dona. ~ ME p(t) pI to pI) 
D., = gmf), ,cose =F KW9, 
D34, = Mtoe 
D359 = 9533 
ta 
D333 = M55 
D3aq7 — ME op (E129, tl op9D) 
D., = gmf. cose + KW.9, 
aaa - 
KW = El | Te (Se le) pec 
1 i 1 1 
oe ys ime 
KW = El | ae Abt eee ON GS em > 
2 P 2 2 


The derived Equations B.15, B.16 and B.17 will become 
the mathematical model of the flexible arm, for the analysis 
presented in Chapter III, when two assumed-modes are to be 


used to express the flexible displacement of the arm. 


B4. EXPRESSING THE FLEXIBILITY WITH THREE ASSUMED-MODES 
By expressing the flexible displacement, uf, with three 


assumed-modes then: 


Up = f1R91 + fard2 + f3Rg3 (B.18) 


Replacing into the Lagrangian function the approximation of 


a Re 


the flexible displacement, given by Equation B.18, the 


following equation is obtained: 


L = — rml“e* + mo* (£, 


2 


+£3593) 


+f, 


E21 “2EY92 


_ & 
tm(f5 9, tfopIottsp93) ]+mle(f, 59, +f5.,95+f5,93) 
(B.19) 


-g{mlsinO+m(f +f +f )cosQ ] 


de eae Lease) 


i 2 2 2 
— =3 (KW, 9, TRY Gg, =KWo93) 


For this model the generalized coordinates are 9, gj, 
92 and g3. Therefore a set of four nonlinear second order 
differential equations will be obtained by taking partial 
derivatives of the Lagrangian function, with respect to each 
generalized coordinate as well as with respect to the rate 
of change of these generalized coordinates and different- 
lating the resulted equations with respect the time. This 


set of the second order differential equations is given as: 


P= Dag? +P 1599, 7913395 Pads Tan? 1 
_ —— (B.20) 
Pa. oe Some 
: at ie _ - 
0 Daa? 4955097 1959392 *Poands (eon eee Boe 
- 2 ae ie 
= 4 7 
OE O31 39057 eases “Pann 2 ee ee (B.22) 
, i ne 7 _ ¥ 
0 = Dy? 494909, 7943392 TPaga93 7P 47319 7 (Be 


where 


2D 2 
Dji41 = Ml” + m(f£1R9,+foRI2tf3Rg3) 
ite 


D = milf 


122 1E 

Bios (lf OR 

” Ee 

a2 amt} 294+ AM yoy geley oS iy aya 
a3 | amt 295+ AWE Tig opps, Meas yall 
a4 | ames J+ SE ono oop 
D, = gml@cosoO - gm(f,,9,+f,,9,+f,,9,) sine 
fo | Top 

e222 mf» 

a3 | Ci Rntok 

ooa4 ~ “linia 

em ams E91 aR92* 1 3K93! 

D. = gmf,,cose > KW9, 

Sem + for 

Beo2 «233 

i333)” mf 

mela OE 3k 

Bee eon iho opoon aR Ia! 

D., = gmf., ,coso + KW.9, 

° a5 came 

pao 244 


afi, 


433 344 

Daag = mis 5 

Dagid 7 Bean a eee 
Dy = gmt, ,coso + KW.9, 


1 7 - 
2 20h | z (2) eyes) cb 


KW = 
: O 
1. ae om 
KW = El | fo (xX) "En Ce)” Pex 
2 0 2 Z 
1, oe ae 
KW, = El | f(x) Eee wax 
0 5 3 
The derived Equations B.20 - B.23 will represent the 


mathematical model of the flexible arm, when the flexible 


displacement will approximated using three assumed-modes. 


B5. THE MODELS FOR THE FLEXIBLE ARM 

A planar robot having one flexible rigid arm will have 
a mathematical model that can be represented by the models 
derived previously. All these models are very similar 
because they were based on the same idea with the difference 
that the flexible end-point displacenent was expressed with 
one, two and three assumed-modes. These models will be used 
with an adaptive control scheme, the velocity curve follow, 
that will be derived in Chapter V. The three different 
models that will be resulted will be simulated in order to 


investigate the performance of the flexible arm. 
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APPENDIX Cc 


SIMULATION PROGRAMS OF THE ADAPTIVE MODEL HAVING A FLEXIBLE 


ARM TO INVESTIGATE THE EFFECTS OF THE ASSUMED MODES 


Cl. APPROXIMATION USING ONE ASSUMED MODE (N=1) 
TITLE SIMULATION PROGRAM FOR THE ADAPTIVE MODEL OF A 
TITLE PLANAR ROBOT ARM HAVING ONE FLEXIBLE LINK. 
TITLE THE FLEXIBILITY WAS APPROXIMATED USING ONE ASSUMED 
TITLE MODE (N=1). 
* 
CONST G=981.4 
* 
PARAM K=1.0, Ki=1.0, K2=10000.0, KM=2.341 
PARAM KT=1036.93 
PARAM VSAT=150.0 
PARAM J=2.38 
PARAM KV=0.1012 
PARAM BM=3 .094, LL=0.0001,R=0.91 
PARAM KW1=0.57 
PARAM M=1.0 
PARAM L=32.0 
PARAM E1=1.8751 
PARAM REF=1.0 
PARAM DT=0.00025 
* 
INTGER N,N1,FLAG,NCHK 
* 
INITIAL 
N=0 
N1=0 
FLAG=0 
Q1=0.0 
Q1D=0.0 
Q1DD=0.0 
TH=0.0 
THD=0.0 
THDD=0.0 
TH1=0.0 
SIG1=(SINH(E1) -SIN(E1) ) /(COSH(E1)+COS(E1)) 
F1=COSH(E1) -COS(E1) -SIG1* (SINH(E1)-SIN(E1) ) 
A=SQRT (2.0*KM*VSAT) 
* 
DERIVATIVE 
RR=REF*STEP (0.0) 
ER=RR-P 
NOSORT 


ity il 


KRREEKKKKKKEKKRKEEKEKKKEKEKEKRKRKEKKKKEKEKKEKEKEKKEKEKEKEKEERKERKEKKRKRKRKKRKRKRKRKRKRKRKRREKE 


KRKRKKK PARAMETERS FOR THE EQUATIONS OF MOTION KKKKKE 
KREKKKKKRKKK KK KK KKK KKK KKK KKK RRR RRR KKERKRKRKEKEKKRKKKKKKKKK 
UE=F1*Q1 


D111=M* (L**2+UE**2) 

D112=2 *M*F1*UE 

D122=M*L*F1 

D1=G*M* (L*COS (TH) -UE*SIN (TH) ) 

D211=M*L*F1 

D222=M*F1**2 

D2111=-M*F1*UE 

D2=G*M*F1*COS (TH) ~KW1*Q1 
KREKEKKEKKEKKKKEKKEKRKEKEKEKKEKEKRKEKRKEKRKRKREKKRKEKRKKRKKKRKRKRKRK KKK KARR KRRKREE 
kkk KR RK THE LAGRANGE'S EQUATIONS OF THE SYSTEM kk RK KKK 
i tt i ie ee ee, i ee a ie ee, ee ee ee ee ee ee ee ie ee ee ee ee ee ee eee 

TL=D122*Q1DD+D112*THD*Q1D+D2 

Q1DD=(D211I*THDD+D2111*THD**2+D2) /D222 
i, i i i, i, i i ee ee ee a ee ee ae ie ee i i a ee i a a eee ee ee ie ee ee a ee a ee ee es 


kkk RK RRR KKK THE ADAPTIVE MODEL kkk KR RK RE K 
kK RK KKK KKK KKK KKK KKK KKK KEK KKK KAKA KKKK KKK KKK RK KKKAKE 
JTOT=J+D111 
IF (ERebi.0.0) Snel 
XDOT=-A*K1*SQRT (ABS (ER) ) 


ELSE 
XDOT=A*K1*SQRT (ER) 
SND ir 
KKKKKKKKKKKKEKKEKKKRKKK KKK KKK KK KKK KK KEK KKK KKK KKKKKKE 
KKK KKK KKK KKK PLEO eiLe ol mh kk RK KR KK KKK KK 


KKKRKKKKKKK KKK KKK RRR KERR RRR RRR KR KKK KKK RRR KKKKRKEKEKKRKE KE 
SORT 

XD=XDOT-K*PD 

V=LIMIT (-VSAT, VSAT, K2 *XD) 


NOSORT 
TF (FIEAG ~EO.1) Ce Te 726 
IF (V.LT.VSAT.AND.TIME.GT.0.0005) FLAG—i 
NCHK=N1 
20 CONTINUE 
SORT 
PDD=KM*V 


PD=INTGRL(0.0, PDD) 
P=INTGRL(0.0, PD) 
VP=V-(KV*THD) 
IM=REALPL(0.0,LL/R, VP/R) 
TM=KT*IM 
TNET=TM-THD*BM-TL 
THDD=(1./JTOT) *TNET 
THD=INTGRL(0.0,THDD) 


THD=INTGRL(0.0, THD) 
KRREEKKKRKRKEKRE KK KKK KKK KKK KKK KKK KREK 


KREKKKKKKKKER ASSUMED MODES KKKKKKKKKEKK 
KK RK KKK KKK KKK KEKE KKK KEKE KEK RE KEK KKK KKKKKKKKKAKKKRKKKKKKEKKE KKK 


Q1D=INTERL (0.0, O1pp) 
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Q1=INTGRL(0.0,Q1D) 
KK KK KK KK KK KK KKK KKK KKK KK KK KKK KKK KKK KK KKK KKKKKKRKRKKKKKKEKEKEKKEEE 


KKKKKKKKKEKK SAMPLING THE SYSTEM kaeKKKKKK KKK 
KARR KKK KKK KEK KEKE KK KKK KKK RE K KK KKK KEK KKK KKK KKK KKK KKK KEKK KKK KEKE 


SAMPLE 
* 


NOSORT 
TRO snOmeNEGO TO 30 
P=TH 
IF (N.GE.2) THEN 
TH1D=(TH-TH2) /(2.*DT) 
ELSE 
TH1D=PD 
END IF 
IF (FLAG.EQ.0) THEN 
PD=(2.*((TH-TH1) /DT) ) -TH1D 
IF (N.GE.2) THEN 
KM=DABS (2. *TH/ (V*((N1*DT) **2) ) ) 
END IF 
END IF 
IF (N1.NE.NCHK) THEN 
PD=(2.*((TH-TH1) /DT) ) -TH1D 
END IF 
30 N=N+1 
N1=N1+1 
TH2=TH1 
TH1=TH 
* 
TERMINAL 


METHOD RKSFX 

* 

CONTRL  FINTIM=2.0, DELT=0.00005, DELS=0.00025 
SAVE (S1) 0.005,XDOT, THD, TH 

* 


GRAPH (L1/S1,DE=TEK618) 
TH (LO=0.0,SC=.2, LE=10,NI=10,UN='RAD'),... 
THD (LO=-8,SC=4.0, LE=8,NI=8),... 
XDOT (LO=-8 , SC=4, LE=8 , NI=8, PO=10) 

* 

GRAPH (L2/S1,DE=TEK618) TIME(UN='SEC'), TH(UN='RAD') 

* 


LABEL (L1) PHASE PLANE OF THE FLEXIBLE BEAM (USING 1-MODE) 
feel (L2) SrTEP RESPONSE OF THE FLEXIBLE BEAM (USING 1-MODE) 
* 


END 
SOP 


CZ. 


APPROXIMATION USING TWO ASSUMED MODES (N=2) 


TITLE SIMULATION PROGRAM FOR THE ADAPTIVE MODEL OF A 
TITLE PLANAR ROBOT ARM HAVING A FLEXIBLE LINK. 
TITLE THE FLEXIBILITY IS APPROXIMATED USING TWO ASSUMED 
TITLE MODES (N=2). 
* 
CONST ese. al 
Ba 
PARAM K=1.0, Kl=1.0, K2=10000.0, KM=2.341 
PARAM KT=1036.93 
PARAM VSAT=150.0 
PARAM J=2.38 
PARAM KV=0.1012 
PARAM BM=3.094, LL=0.0001,R=0.91 
PARAM M=1.0 
PARAM L=32.0 
PARAM EF1=1.8751, E2=4.6941 
PARAM KW1=0.00124, KW2=0.0433 
PARAM REF=1.0 
PARAM DT=0.00025 
* 
INTGER N, Nl, FLAG, NCHK 
* 
INITIAL 
N=0 
N1=0 
FLAG=0 
QD=0.0 
Q1=0.0 
Q1D=0.0 
Q2=0.0 
Q2D=0.0 
Q2DD=0.0 
TH=0.0 
THD=0.0 
THDD=0.0 
TH1=0.0 
SIG1=(SINH(E1) -SIN(E1) ) / (COSH(E1) +COS(E1) ) 
SIG2=(SINH(E2) -SIN(E2) ) / (COSH(E2)+COS(E2) ) 
F1=COSH(E1) -COS(E1) -SIG1* (SINH(E1) -SIN(E1) ) 
F2=COSH (E2) -COS (E2) -SIG2* (SINH(E2) -SIN(E2) ) 
A=SQRT (2.0*KM*VSAT) 
* 
DERIVATIVE 
RR=REF*STEP(0.0) 
ER=RR-P 
NOSORT 


KREKKKKKKEKKEKEKK KERR KKK KKK KKK KKK KKK KKEKKKKEKEREKKKEKKKKEKKKKEKEKE 


KKREKKK 


PARAMETERS FOR THE EQUATIONS OF MOTION KKK KKK 


KRREKKKKKEKKKRKRKRKRKKEKREKEKEKKKEKKKEKRKKEKEKKRRA RRR RRR RK KKRAKKKXKAK AK 


UE=F1*Q1+F2*Q2 
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D111=M* (L**2+UE**2) 

D112=2*M*F1*UE 

D113=2*M*F2*UE 

D122=M*L*Fl 

D133=M*L*F2 

D1=G*M* (L*COS (TH) -UE*SIN (TH) ) 

D211=M*L*F1l 

D222=M*F1**2 

D233=M*F1*F2 

D2111=-M*F1*UE 

D2=G*M*F1*COS (TH) +KW1*Q1 

D311=M*L*F2 

D322=D233 

D333=M*F2**2 

D3111=-M*F2*UE 

D3=G*M* F2*COS (TH) +KW2*Q2 
KHEKEKEKKKKKKKKKKKKKEKEKKEKKKKKEKKKKKKKKRKEKKRKKKKKEKKEKKKKKKKKKKKRKKKEEE 
kk KKK THE LAGRANGE'S EQUATIONS OF THE SYSTEM kk KKK 
KKEKEKKKKEKKKEKKKKKEKEKKKKKEKEKKEKEKKKEKKKKKEKRKEKKEK KKK KEKKKKKKKKKEKKER 

TL=D122*QD+D133 *Q2DD+D112 * THD*Q1D+D113*THD*Q2D+D1 

Q1DD= (D211*THDD+D233*Q2DD+D2111*THD**2+D2) /D222 

Q2DD= (D311*THDD+D3 22 *QD+D3111*THD**2+D3) /D333 


QD=01DD 
KEK KKK KKK KK KKK KKK KKK KKK KKK KKK RK KKK RRR KKK KKK KKRAKEEE 
kkKK KKK KKK THE ADAPTIVE MODEL kaKKKKKKK KE 


KREEKEKKKEKEKEKRKEKEKKKEKKERREKRKEKKEKRKEKRREKRREREKRKEKRKEKEKEKRKEKRKRKRREKRKKEKEKEKRKEKKKKRRREEE 


JTOT=J+D111 
IF (ER.LT.0.0) THEN 
XDOT=-A*K1*SQRT (ABS (ER) ) 


Ja LS 
XDOT=A*K1*SQRT (ER) 
END IF 
KRKEKKKKKKKKK KKK KKK KKK KKK KKK KKK KKK KK KKK KKK KK RRR KK KKK EKK 
KAKKKKKKKKKKE FLEXIBLE LINK KKKKKKKKKKKE 


KHREKKEKKKRKEKKKRKRKKRKRKKKRKRKKKRKERKKKKKKK KKK KKK KKK KKK 
SORT 

XD=XDOT-K* PD 

V=LIMIT (-VSAT, VSAT, K2*XD) 


NOSORT 
IF (FLAG.EQ.1) GO TO 20 
IF (V.LT.VSAT.AND.TIME.GT.0.0005) FLAG=1 
NCHK=N1 
20 CONTINUE 
SORT 
PDD=KM*V 


PB=INTGRL (0.0, PDD) 
P=INTGRL(0.0, PD) 

VP=V- (KV*THD) 
IM=REALPL(0.0,LL/R, VP/R) 
TM=KT*IM 
TNET=TM-THD*BM-TL 
THDD=(1./JTOT) *TNET 


2s 


THD=INTGRL (0.0, THDD) 


TH=INTGRL(0.0,THD) 
KH KKK KKK KKK KKK KKK KKK KKK KKK KKK KKK 


KAKKKKKKKEKK ASSUMED MODES KaRKKKKKKKKK KK 
KKK KKK KKK KKK KR KEK KK KKK KKK KKK KKK KKK KEK RRR RRR KK KKK KERR KKKKK 


Q1D=INTGRL(0.0,Q1DD) 
Q2D=INTGRL(0.0,Q2DD) 
Q1=INTGRL(0.0,0Q1D) 
Q2=INTGRL(0.0,Q2D) 
BRK KKK KKK 


kkk kk RR RK SAMPLING THE SYSTEM kK KKK KK KKK 
eee ee ee ee ee ee eee ee ee ee 
SAMPLE 
NOSORT 


IF (N.EQ.0) GO TO 30 

P=TH 

IF (N.GE.2) THEN 

THID=(TH-TH2) /(2.*DT) 

ELSE | 

TH1D=PD 

END IF 

IF (FLAG.EQ.0) THEN 
PD=(2.*((TH-TH1) /DT) )-TH1D 
IF (N.GE.2) THEN 

KM=DABS (2. *TH/(V*( (N1*DT) **2)) ) 

END IF 

END IF 

IF (N1.NE.NCHK) THEN 
PD=(2.*((TH-TH1) /DT) )-TH1D 


END IF 
30 N=N+1 
N1=N1+1 
TH2=TH1 
TH1=TH 
* 
TERMINAL 
METHOD RKSFX 
* 
CONTRL FINTIM=2.0, DELT=0.00005, DELS—0.00025 


SAVE (S1) 0.005,XDOT, THD, TH 
* 


GRAPH (L1/S1,DE=TEK618) 
TH (LO=0.0,SC=.2, LE=10,NI=10,UN='RAD'),... 
THD (LO=-8 ,SC=4.0, LE=8,NI=8),... 
XDOT (LO=-8 ,SC=4, LE=8 , NI=8, PO=10) 
GRAPH (L2/S1,DE=TEK618) TIME(UN='SEC'), TH(UN='RAD') 
* 


LABEL (L1) PHASE PLANE OF THE FLEXIBLE ARM (USING 2-MODES) 
LABEL (L2) STEP RESPONSE OF THE FLEXT BLE ARM MUSING 2-=MOpz. 
* 


END 
SOF 
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eo). 


TITLE SIMULATION PROGRAM FOR THE ADAPTIVE MODEL OF A 
TITLE PLANAR ROBOT ARM HAVING A FLEXIBLE LINK. 
TITLE THE FLEXIBILITY IS APPROXIMATED USING THREE ASSUMED 
TITLE MODES (N=3). 
* 
CONST G=981.4 
* 
PARAM K=1.0, K1=1.0, K2=10000.0, KM=2.341 
PARAM KT=1036.93 
PARAM VSAT=150.0 
PARAM J=2.38 
PARAM KV=0.1012 
PARAM BM=3.094, LL=0.0001,R=0.91 
PARAM M=1.0 
PARAM L=32.0 
PARAM E1=1.8751, E2=4.6941, E3=7.85467 
PARAM KW1=0.00124, KW2=0.0433, KW3=0.357 
PARAM REF=1.0 
PARAM DT=0.00025 
x 
INTGER WN, Nl, FLAG, NCHK 
x 
INITIAL 
N=0 
N1=0 
FLAG=0 
QD1=0.0 
QD2=0.0 
Q1=0.0 
Q1D=0.0 
Q2=0.0 
Q2D=0.0 
Q3=0.0 
Q3D=0.0 
Q3DD=0.0 
TH=0.0 
THD=0.0 
THDD=0.0 
TH1=0.0 
SIG1=(SINH(E1) -SIN(E1) ) /(COSH(E1)+COS(E1) ) 
SIG2=(SINH(E2)-SIN(E2) ) / (COSH(E2)+COS(E2) ) 
SIG3=(SINH(E3)-SIN(E3) ) / (COSH(E3)+COS(E3) ) 
F1=COSH (El) -COS(E1)-SIG1* (SINH(E1)-SIN(E1) ) 
F2=COSH (E2) -COS(E2) -SIG2* (SINH(E2) -SIN(E2) ) 
F3=COSH(E3) -COS(E3) -SIG3* (SINH(E3)-SIN(E3) ) 
A=SQRT (2.0*KM*VSAT) 
* 
DERIVATIVE 


APPROXIMATION USING THREE ASSUMED MODES (N=3) 


RR=REF*STEP(0.0) 
ER=RR-P 
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NOSORT 
KKEKKKKKEKKKEKEKKKKERREKKRKRERRRERKRKRRKKKRRKRKERRREKRRRRRRERKRERE 


tok k Ak PARAMETERS FOR THE EQUATIONS OF MOTION kkk Rk 
KRRERKEKKRKKEKEKRKEKKERKERKEKERKERKR KERR KR KRERREKRKRARKKRRARRKRKRRKRKRKRKRRREEE 
UE=F1*Q1+F2*Q2+F3*Q3 
D111=M* (L**2+UE**2) 
D112=2*M*F1*UE 
D113=2*M*F2*UE 
D114=2*M*F3*UE 
D122=M*L*F1 
D133=M*L*F2 
D144=M*L*F3 
D1=G*M* (L*COS (TH) -UE*SIN(TH) ) 
D211=M*L*F1l 
D222=M*F1**2 
D233=M*F1*F2 
D244=M*F1*F3 
D2111=-M*F1*UE 
D2=G*M*F1*COS (TH) +KW1*Q1 
D311=M*L*F2 
D322=D233 
D333=M*F2**2 
D344=M*F2*F3 
D3111=-M*F2*UE 
D3=G*M* F2*COS (TH) +KW2*Q2 
D411=M* L*F3 
D422=D244 
D433=D344 
D444=M*F3**2 
D4111=-M*F3*UE 
D4=G*M*F3 *COS (TH) +KW3*Q3 
tS ee ee ee ee ee ee ee ee ee ee ee ee, a ee ee ae ee ee ee ee 
ARK KK THE LAGRANGE'S EQUATIONS OF THE SYSTEM hk k kk 
RREREKKRARKKRKRKKRKKKRKKKKKKKKRKRKRKRKRKRKRRKRK RRR RRR RRR RRR KKK 
TL=D122*QD1+D133*QD2+D144*Q3DD... 
+D112*THD*Q1D+D113*THD*Q2D+D114*THD*Q3D+D1 
Q1DD= (D211*THDD+D233*QD2+D244*Q3DD... 
+D2111*THD**2+D2) /D222 
Q2DD= (D311*THDD+D322*QD1+D344*Q3DD... 
+D3111*THD**2+D3) /D333 
Q3DD=(D411*THDD+D422*QD1+D433*QD2... 
+D4111*THD**2+D4) /D444 


QD1=Q1DD 

QD2=02DD 
ROR RK RR kk kk kk kk kk kk ek kk ek ek RR RR RR RR RR KR 
kok ck ee ke ke ek THE ADAPTIVE MODEL ek ek kk ee 


tir ii ee ee ee ee ee ee a ae ee ee ee ee ee ee ie ee ae ie ie ee, ee 
JTOT=J+D111 
IF (ER.LT.0.0) THEN 
XDOT=-A*K1*SQRT (ABS (ER) ) 
ELSE 
XDOT=A*K1*SQRT (ER) 


TZ5 


SND ir 
KKK KK KK KK IK KK IKK KKK RIK KKK KKK KKK KEK KEK KKK KEKE KEK KKK KKK KKK KKK 


kk KKK RK KEK FLEXIBLE LINK kk RK KR KK RK KKK 
KKK KK KK KK KK KK IK KK IKK KK IK KK IK KK KKK KKK KR KKK RK RRR KERR KEKE KK KK 
SORT 

XD=XDOT-K* PD 

V-DiMil (=Vvsal,, VSAT ,K2* xD) 


NOSORT 
IF (FLAG.EQ.1) GO TO 20 
IF (V.LT.VSAT.AND.TIME.GT.0.0005) FLAG=1 
NCHK=N1 
20 CONTINUE 
SORT 
PDD=KM*V 


PD=INTGRL (0.0, PDD) 
P=INTGRL(0.0, PD) 
VP=V-(KV*THD) 
IM=REALPL(0.0,LL/R,VP/R) 
TM=KT* IM 
TNET=TM-THD*BM-TL 
THDD=(1./JTOT) *TNET 
THD=INTGRL(0.0,THDD) 


TH=INTGRL(0.0, THD) 
KRKEKKKKEKEKKKEKKRK KKK KKK RK KK KKK KKK KKK KKK KKK 


KKK KKK KEKE KEK ASSUMED MODES ke KK RK KEK ER 
KK KKK IK KKK KKK KK KKK I KI KK KK KKK KK IK KKK RK RRR RRR KERR KER RRR KEK K KK 


Q1D=INTGRL(0.0,Q1DD) 

Q2D=INTGRL(0.0,Q2DD) 

Q3D=INTGRL(0.0,93DD) 

Q1=INTGRL(0.0,Q1D) 

Q2=INTGRL(0.0,Q2D) 

Q3=INTGRL(0.0,03D) 
KREKKKKEKEKKEKKEKKEKEKEKEKERKRKERKRRKEKKERKEKRK KKK KKK 


kk RK KR RR KK SAMPLING THE SYSTEM kk RRR EK 
KK KK KK KK KK KK KK KKK KKK KK KK KKK KK KKK KK KK KKK KK KK RRR RRR KKK KKK KKK 
SAMPLE 

* 

NOSORT 


IF (N.EQ.0) GO TO 30 

P=TH 

IF (N.GE.2) THEN 
TH1D=(TH-TH2) /(2.*DT) 

ELSE 
TH1D=PD 

END IF 

IF (FLAG.EQ.0) THEN 
PD=(2.*((TH-TH1) /DT) ) -TH1D 
IF (N.GE.2) THEN 

KM=DABS (2.*TH/ (V*((N1*DT) **2))) 

END IF 

END IF 

IF (N1.NE.NCHK) THEN 


2S 


PD=(2.*((TH-TH1) /DT) ) -TH1D 


END ere 

S110, N=N+1 
N1I=N1+1 
TH2=TH1 
TH1I=TH 

* 

TERMINAL 

METHOD RKSFX 


* 


CONTRL FINTIM=3.0, DELT=0.00005, DELS=0.00025 
SAVE (S1) 0.005,XDOT, THD, TH 
* 


GRAPH (L1/S1,DE=TEK618) 
TH (LO=0.0,SC=.2, LE=10,NI=10,UN='RAD'),... 
THD (LO=-8,SC=4.0,LE=8,NI=8),... 
XDOT (LO=-8 , SC=4.0, LE=8 , NI=8 , PO=10) 
* 
GRAPH (L2/S1,DE=TEK618) TIME(UN='SEC'), TH(UN='RAD') 
* 


LABEL (L1) PHASE PLANE OF THE FLEXIBLE ARM (USING 3-MODES) 
LABEL (L2) STEP RESPONSE OF THE FLEXIBLE ARM (USING 3-MODES) 
k 


END 
STOP 


Le 


APPENDIX D 


DERIVATION OF THE MODEL FOR A TWO LINKS PLANAR ROBOT ARM 


HAVING ONE RIGID AND ONE FLEXIBLE LINKS 


In this Appendix, a complete derivation will be given 
for the mathematical model of the proposed two links planar 
robot arm having the first link rigid and the second link 
flexible. The set of the second order differential equa- 
tions of motion that describe the proposed system will be 
derived using the Lagrangian dynamics approach. For the 
sake of the analysis Figure 3.2 given in Chapter III, 
illustrating the coordinates of the system for both the 
rigid and the flexible links will be repeated as Figure D.1, 
in order to give a better understanding in the derivation of 
the kinetic and the potential energies. 

The Lagrangian function will again be given as L=T-V, 
where T and V are the kinetic and the potential energies of 
the system respectively. The kinetic and potential energies 
will derived from the kinetic and potential energies of the 
Individual links. Therefore T=T,+T> and V=Vj+V>, where 
T,,Vz and T5,V> are the kinetic and potential energies of 
the rigid and the flexible link respectively. 


The kinetic energy for the rigid link will be given as: 


aa 2. 
LL — — mM 1,9 


1 > enol (D.1) 


2 
i 


ial 


Gravitational Force 


x-Y Plane 





Figure D.1 Coordinates configuration of the (rigid- 
flexible) two links planar robot system. 


The kinetic energy of the flexible link will be: 


eal -2 "2 
T = Sere m. (X, an Y>) (D.2) 
where x5 and y> are the end-point Cartesian coordinates of 


ie 


the flexible beam. The transformation to the generalized 


coordinates, that were selected to describe that system, was 


given in Chapter III, with equations 3.2 and 3.3. 


Taking 


the derivatives of these equations the velocity components 


will be represented as: 


x, = -1,0,sino, 2 1, (8,+8,)sin(e,+0,) 

- u,sin(®,+6,)- u,(@,+8,)sin(@,+6,) 
Y, = 1,0,cose, + 1, (0, +8,) cos (0, +0,) 

- u,cos (0, +8,) - u,(0,+8,)sin(0,+0,) 


Taking the squares of the above equations then: 


2 Lp Bape ae aa ae Pie ace 

xX = 1,0,sin 0, +1, (9,+9,) sin (0, +0 

spit (6 +0 \*cos“(@ anShe Peo ila cll 6 (0 +0 
Peel. 2 i lee, all 


tup,sin(9,+0,) [1,9,sino,+1,(9,+9,) 


Fl up, (9, +9.) sine, cos(0,+0,) 


: : ; a 
tlou,(0,+0,)sin (9, +0.) 


; soy 
+tlju, (9, +95) Sin(0,+0.,)cos(0,+0,) 


tupu, (0,+9,)sin(0,+9,)cos(9,+0,) 


i a2 2 oa: ; 2 2 
Y> = 1,0 cos 0, t1,(9,+9,) cos (9, +0 


hr Nh 


Z 


> , ak ee 
tu, (9,+9,) cos (0, +0,) +1, 1,9, (9, +9 


aS 


>) 


>) 


>) 


>) 


+usin® (0, +0 


sing 


E 


+udcos* (0, +0 


cosd 


I 


it 


2 


+ 
sin(0, 3) 


sin(®,+9,) ] 


Zz 


cos(0,+0 


) 


>) 


) 


>) 


(D.3) 


(D.4) 


(D.5) 


a j : : 5 
+1 ,u,8,c0s®,cos(9,+0,)+1,u,(9,+9,) cos (©, +0,) 


-1, x (8, +0 >) cose sin(9, +9 >) (.Dii6)} 


1 
up, (9, +9.) cos (0, +0,)sin(6, +9.) 
up, (9, +9.) cos (9, +9,)sin(6,+0,) 


Combining Equations D.5 and D.6 into Equation D.2, and using 
trigonometric identities to simplify the expression, the 


kinetic energy for the flexible link obtains the form: 


r= m, [176 “+12 (9, +0 5) oe us (0, +0 ae 
2 2 R 
+21,1,9, (9,+9,) cose,+ 21,u,0, cos, (D.7) 


+21, (8, 748, )Upt 21 Une a Comme = lances ml 


To obtain the final form of the kinetic energy for the 
flexible link, the flexible displacement up and velocity up 
can be substituted from the expressions derived in Chapter 
III as given by Equations 3.6 and 3.7 respectively. For 
motions of the flexible arm in the range -90°<@5<90° then 


Sin(-@5)= -sinO5. Therefore the total kinetic energy of the 


system is: 


Spe Ail 92 poe. Dee : 2 : ; 2 
Al = 255 [mM Me O,t+m,1,9,+m 1, (9,+8,) tm, (£,59,+!5p9,) ] 
“te — m (0 +0 yet: 6 i 5) oe © | ) +m 1 1,0 (0 +0 ) cosoO 
2 2 ali 2 Sl seat 2-2 Z it wo ile 2 2 (D.8) 
+ mo1,9, (£,,9,+'5~95)cose,+m,1, (9,+9,) (£,7,9,+f5795) 
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m,1,9, (9,+9,) (£,,9,+f5p9,) sine, 


The potential energy for the rigid link will be: 


V, = gm, 1,sino 


: (D.9) 


il 


For the flexible link the potential energy will be composed 
of the energy associated with the rigid motion plus the 
elastic potential energy. Assuming the magnitude of the 
elastic motion small compared to the overall motion, meaning 
small amplitude of the flexible displacement u, the potent- 


jal energy of the flexible link can be written as: 


V5 = gm, {l,sino,+l,sin(0,+0.,)+u,cos(6,+8,) ] 
1 : CD20) 
1 Z JQ 
=f 5 Ea (oe CLS 
2 O 6X 


where EI is the stiffness of the flexible link, assumed 
constant for the purpose of this model. 

Substituting the flexible displacement up with the 
equivalent expression, derived in Chapter III, given by 
Equation 3.6, the integral involved in the potential energy 


of the flexible beam can be evaluated as follows: 


1 > 1 as eee 
Zz Osu 2 Z 2 2 
| EL (yz) ax=E1| (f£,9,+f,9,) dx=KW, g,+KW.g. (Dei) 
O O 
where 
1, a 
KW, = EL | (ft, f,) Gx 
O 
and 
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1, ‘cence 
KW. = EI I (f. f.) dx 


Therefore the total potential energy of the system becomes: 


V= g{m,1,sino,+m,1, sine, +m,1,sin(6,+0,) 
al 2 2 (Dar 
tm, (£159, +!,79,)c08(9,+9,) ]- = (KW, g,+KW.g, ) 


The Lagrangian function, L, will then can be computed from 


the Equations D.8 and D.12, as follows: 


Le = (m,+m,)1%02+m,1° (9, +8.) *+m, (0, +0,)° (£59,425 .de z 
+m, (£159, +£5_9>) “]+m,1,1,0, (6,+6,) cose, 

+m,1,8, (£1 "9, +£5 p95) OS®, +m,1, (8,+8,) (£, 5, +£5555) (D. 13) 
m,1,0, (0,+8,) (£,_9,+£,,95)sin®,-[(m,+m,)1,sine, 
+m,1,sin(6,+0,)+m,(f£,,9, +£5.95) cos(9,+8,) 1g 

+ > (KW +KW95) 


Having derived the Lagrangian function, the differential 
equations that describe this system can be obtained by 
forming the Lagrange's equations that have the general form 
given from Equation 3.8 in Chapter III. For this partmevian 
system the generalized coordinates are defined to be 0), 95, 
gj; and g>. Therefore a set of four nonlinear second order 
differential equations will be obtained by taking partial 
derivatives of the Lagrangian function with respect to each 
generalized coordinate and their corresponding velocities 


L336 


and differentiated with respect to time. This approach with 
mecpect to 67 gives: 


é6L 


so. = 7((m +m )1 cos® +m 1 cos(© +0 ) 
i 


(D.14) 
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m., (£,,9,+f£,,9,)sin(9,+9,) }g 
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E92) 


(m, +m 


5° 5° - i ‘ 
5) 1,9, +m, 1, (9, +9,) tm, (9, +9,) (f,,9, 11, 
60, 


e e 


+m. 1 ie cos®.t+2m Ih leks, cosO,tmj 1, (f, 


ite Doda | COS 


Se ha 
E?1 2E2 2.15) 


tmo 1, (£479, +f5 p95) Mo 1,9, (£479, +f, 795) Sine, 


-2m1,0,(f, sino 


+£5.29) 2 


E91 


7 5° 5° 5° ae 
)=(m,+m,)1)9, +m,1,59, +tm,1,50, +m,0, (£559, 


d_ (_éL 
dt 


60, 





+£5R9>) 


ee , , 
ee og) 1h Ro1 Io) oa We 2B 291 


— ae 
+2m50, 25 7959572M5 951159191 


+2m,05f4 51579792 


. P ‘ > ae 
+2m,0,f,) 5157959, 72m,9,f,5,959,7+m,1,1,°, cose, 


+2m,1,1,9, cos©.-m,1,1,°, Sin@.,-2m,1,1,0,9.,s1ino9,, 


(D.16) 


tm, 1,cos0,(f,.9, +£595 )-m,1,0,(f£,,9,+f,,9,)51n9, 


tm5 tty tMglo Fo pFy —MZ1195 (6129, +f5p95)S1Nn9, 


“5 : | : : 
m51,95 (£5759, 715795) c0S9,-m,1,9,51n0, (£,,9, +£5.95) 


mol, (£,59,+f5795) (9, S1in0.+0,9.cose, ) 
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~2m,1,9,1,,9,Sine,-2m,1,0,f,,9,s1n0, 


Combining the above Equations D.14 and D.16 the first non- 
linear second order differential equation can be derived, as 
given in Chapter III by Equation 3.9. The same approach 
with respect to 85 gives: 


éL 


$0, =-m,1,1,°, (9,+90,)sine,-m,1,9, (£,,9, +£5.95) s1n9, 


~m,1,9, (9, +8,) (£,,9,+f,79,) cose,- g(m,l.,cos(0,+0,) (D.17) 


-m., (f )sin(©,+6,)] 
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= mo150,+m,9, (£559, +f 5595) +m,9, (£129, +f579>) 


60. 


mol, (£79 +15 p95) -M51,9, (£,79,+£579,) Sine, (D.18) 


5° ; 
tm, 1,0,+m,1,1,9,cose,, 


qa 
dt 


5° 5° 5° 5 Pa, 
156 +m 1,9, tm, (f,,9,+f e +2m,£5591919) 


come 
(~~~) =m (i as, 2EI2) 94 
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60. 


a Fe ee: 
et pen po epoch le Likamer one 5) 


t2m5f4 5t5 791959) 
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12919 9a t2M5 Fy pt 5 p91 92% 


5° 
tm, (£559, +15795) 0, +2mof 


a 5 geass ae 
+2m50) ot 5 pI 9295+ 2m, f57959,9,+m,1,1,9, cosé., (D. 73) 


~m,1,1,9,9,s1ine,+m1,f,59) ~mo1,f£,,9,9,S1n9, 


~mo1,f,79,9,S1ne,-m,1,(£,,9,+f,5795) 9, Sino. 


)©,9.cose,+m,1,f,.g9, 
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mot, (f,59,tf529> 


The second nonlinear second-order differential equation that 
describes the system will result from the above Equations 
bet? and D.19, Having the final form given by the Equation 
Belo in Chapter ~EITI. With respect to the generalized 


Seerdinate g, this approach gives: 





. A a Saar, 
6g, He Wg ie) aegis poe 
(D.20) 
mj1,9, (8, +9,)£,,s1n8,-gm,f,,cos(6,+90,)+KW,g, 
as =m (£° g a ame 5 steal 6 ff. Coser (6 +0 | Sin (D221) 
: te eo oe at) 1G ee a OE 
6g, 
F Se saree - . 
at § ay ee ee Oo? > 
or (Ds 22) 
~mo1,f£,,9,9,sine,+m,1,f,,9, tmo1,f,,95 


Combining Equations D.20 and D.22 the third nonlinear second 
order differential equation can be produced with its final 
form Given in Chapter IIIT by Equation 3.11. The last 
Equation 3.12 of the second order differential equations 
given in Chapter III, can be derived from the given below 
ficuations D.23 and D.25). These equations can be derived 
by following the same procedure with respect to the fourth 


pemeralized coordinate g>. 


iy 2 lee ee 
6g, Hib Wey Peg) Norge aE) Wek ha) | le asep hoch 
(De 285 
~m51,0, (9, +9.) f,,s1n0,-gm,f,,.cos (9, +0.) +KW.g., 
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6L 2 





=m, (£5,95+£, piop 9, on temeCscee (05 non) te an (Derm 
6g. 
a ae my oc _ 
ae ) = MlopIo tMolyptoe9, +MQ1,1579, 5988, 
725 (D.25) 
tmi1,f,,9, tm,1,f,,95 -m,1,£,,9,9,s1n9e, 
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APPENDIX  E 
SIMULATION PROGRAM FOR THE BASIC MODEL OF THE 


VELOCITY CURVE FOLLOW CONTROL SCHEME 


TITLE ADAPTIVE VELOCITY CURVE FOLLOW CONTROL SCHEME 
* 
PARAM K1=0.8, K2=10000., KM=0.185, VSAT=300.0, K=1.0 
PARAM INP=1.0 
* 
INITIAL 
A=SQRT (2. *KM*VSAT) 
VEL=0.0 
* 
DERIVATIVE 
R=INP*STEP (0.0) 
ER=R-C 
NOSORT 
IF (ER.LT.0.0) THEN 
VEL=-A*K1*SQRT (ABS (ER) ) 
ELSE 
VEL=A*K1*SQRT (ER) 
END IF 
SORT 


DVEL=VEL-FBVEL 
FBVEL=K*CDOT 
AMP=LIMIT (-VSAT, VSAT, K2*DVEL) 
CDDOT=KM*AMP 
CDOT=INTGRL(0.0,CDDOT) 
C=INTGRL(0.0, CDOT) 
* 
METHOD RKSFX 
CONTROL FINTIM=0.4, DELT=0.0001 
Baye  (S1) 0.001, C, CDOT, VEL 
SAVE (sep o00l. ¢, R 
* 
GRAPH (G1/S1,DE=TEK618,PO=0,0) 
C(LE=8 , NI=10,§C=0.1 ,UN='RAD'), 
VEL(LE=4 , NI=4, LO=0, SC=$AR, UN='RAD/SEC'),... 
CDOT (LE=4 , NI=4, LO=0, SC=$AR, UN='RAD/SEC', PO=8) 
GRAPH (G2/S2,DE=TEK618,0V,PO=0,5) 
TIME (LE=8,UN='SECOND'),... 
C(LE=4,NI=4, LO=0,UN='RAD' ,SC=0.5), 
R(LE=4 ,NI=4,LO=0,SC=0.5,AX=OMIT) 
LABEL (G1) PHASE PLANE 
LABEL (G2) STEP RESPONSE 
END 
STOP 
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PARAM 
PARAM 


PARAM 
k 


INTGER 


* 


INITIAL 


APPENDIX F 


SIMULATION PROGRAM FOR THE TwO LINKS 


(RIGID-RIGID) PLANAR ROBOT ARM 


SIMULATION PROGRAM OF THE ADAPTIVE MODEL FOR THE 
PLANAR ROBOT ARM HAVING TWO RIGID LINKS. 


THIS PROGRAM WAS USED FOR THE SIMULATION RESULTS 
FOR THAT SYSTEM, WITH OR WITHOUT LOAD AS ALSO 
WITH OR WITHOUT THE GRAVITATIONAL FORCES. 


G=981.4 
ZL=0.0 


K1=0.8,K2=10000. , K3=1.0,KM1=0.162, KM2=2.045,K=1.0 
KT1=1036.93, KT2=1036.93 
VSAT1=300.0, VSAT2=150.0 
J1=2.38,J72=2.38 
KV1=0.1012,KV2=0.1012 
R1=0.91,R2=0.91,L=0.0001 
BM1=3.094, BM2=3.094 
L1=40.0, L2=32.0 
M1=3.0,M2=0.5 
REF1=1.0,REF2=1.0 
DT=0.00025 


N,N1,N2,NCHK1,NCHK2,FLAG1, FLAG2 


N=0 

N1=0 

N2=0 

FLAG1=0 

FLAG2=0 

P1=0.0 

P2=0.0 

P1D=0.0 

P2D=0.0 

TH1=0.0 

TH2=0.0 

TH11=0.0 

TH21=0.0 

TH1D=0.0 

TH2D=0.0 

TH1DD=0.0 

TH2DD=0.0 
A1=SQRT(2.*KM1*VSAT1) 
A2=SQRT (2. *KM2*VSAT2) 
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* 


DERIVATIVE 

RR1=REF1*STEP (0.0) 

RR2=REF2*STEP(0.0) 

RRD2=TRANSP(200,0.0,0.1,RR2) 

E1=RR1-P1l 

E2=RRD2-P2 
NOSORT 
KREKEKKKKKKKKRKKKKRKRKRKRKKKRKRRKRKREKRKRREKKRKKKKEKKEKRREKEKEKRKKRKERRREKREE 
kK KKK PARAMETERS FOR THE EQUATIONS OF MOTION kK RK 
KREKKKKKKKKKKKRKKKKKKKK KKK KRKEKERREKRREEER 

TH=TH1+TH2 

D11=(M1+M2) *(L1**2)+M2* (L2**2)+2*M2*L1*L2*COS (TH2) 

D12=M2* (L2**2) +M2*L1*L2*COS (TH2) 

D22=M2* (L2**2) 

D122=-M2*L1*L2*SIN(TH2) 

D112=D122 

D211=-D112 

D1=(M1+M2) *G*L1*COS (TH1) +M2*G*L2*COS (TH) 

D2=M2*G*L2*COS (TH) 
KKRKEKKKEKEKRKKEKRKEKRKERKKERKK KKK RRR RRR RRRKRKRESE 
kK RK RR EK DIFFERENTIAL EQUATIONS Hk RR RR 
KEE KKK KKK KKK KKK KKK RRR RRRRREEHK 

TL1=D12*TH2DD+D122*TH2D**2+2*D112*TH1D*TH2D+D1 

TL2=D12*TH1DD+D211*TH1D**2+D2 


JTOT1=J1+D11 

TTOT2=32+D22 

IF (El1.LT.0.0) THEN 
X1DOT=-A1*K1*SQRT(ABS(E1) ) 

ELSE 
X1DOT=A1*K1*SQRT(E1) 

END IF 

IF (E2.LT.0.0) THEN 
X2DOT=-A2 *K3 *SQRT (ABS (E2) ) 


ELSE 
X2DOT=A2 *K3 *SQRT (E2) 
END IF 
SORT 
KKEKKKKKEKK RRR RRR ERR KERR RRR RRR KR RRR RRR RRR RRR RE RREKRKRKKRKKER 
KKEKKKKKKKKEKEKE Line i KAKKKKKKKKRKKKEK 


KREKEK KKK RRR KKK RR KK RR KK KR KERR RK RRR RRR RRR RRR RRR RRR RREKRKERRKKKRKKE 
X1D=X1DOT-K*P1D 
V1=LIMIT (-VSAT1,VSAT1,K2*X1D) 


NOSORT 
IF (FLAG1.EQ.1) GO TO 5 
IF (V1.LT.VSAT1.AND.TIME.GT.0.0005) FLAG1=1 
NCHK1=N1 
5 CONTINUE 
SORT 


P1DD=KM1*V1 
P1D=INTGRL(0.0,P1DD) 
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P1=INTGRL(0.0,P1D) 

VP1=V1- (KV1*TH1D) 
IM1=REALPL(0.0,L/R1,VP1/R1) 
TM1=KT1*IM1 
TNET1=TM1-TH1D*BM1-TL1 
TH1DD=(1./JTOT1) *TNET1 
TH1D=INTGRL(0.0,TH1DD) 


TH1=INTGRL(0.0,TH1D) 
KeK KKK KKK KK KKK KKK KK KKK KK KKK KKK KEKKKKKEKKKKKKKKKKKKKKKEEK 


KKK KKKKKKKKKEK LINK 2 kkk kk eK Re 
kk KKK KKK KK KKK KKK KKK KKK K KKK KKK KKK KKK KKK KKK KK KKK 


X2D=X2DOT-K*P2D 
V2=LIMIT(-VSAT2,VSAT2 , K2*X2D) 


NOSORT 
TF (FLAG2.EO™1) come 7 
IF (V2.LT.VSAT2.AND. TiMe scr. 0. 0005). Fanez— i 
NCHK2=N2 
Zi CONTINUE 
SORT 


P2DD=KM2*V2 
P2D=INTGRL(0.0,P2DD) 
P2=INTGRL(0.0,P2D) 
VP2=V2-(KV2*TH2D) 
IM2=REALPL(0.0,L/R2,VP2/R2) 
TM2=KT2*IM2 
TNET2=TM2-TH2D*BM2-TL2 
TH2DD=(1./JTOT2) *TNET2 
TH2D=INTGRL(0.0,TH2DD) 


TH2=INTGRL(0.0,TH2D) 
KKEKEKKKKKKKKKKK KK KKK KK KKK KK KK KKK KK KKK KKK KKK KKK KKKKKKEKKEEKEEKE 


kkk tek ke ee ee SAMPLING THE SYSTEM kk RRR KKK KEK 
Khe KKK RR KKK KKK KKK KKK KKK KR KR RRR KKK RR KKK KKK KKK KKK KAKA K KE 
SAMPLE 
NOSORT 

iF (N.EQ20) GOCTeGeZo 

P2=TH2 

P1=TH1 


IF (N.GE.2) THEN 

TH21D=(TH2-TH22) /(2.*DT) 

TH11D=(TH1-TH12) /(2.*DT) 

ELSE 

TH21D=P2D 

TH11D=P1D 

END IF 

IF (FLAG2.EQ.0) THEN 
P2D=(2.*((TH2-TH21) /DT) ) -TH21D 
IF (N.GE.2) THEN 

KM2=DABS (2.0*TH2/ (V2*((N2*DT) **2) ) ) 

END IF 

END IF 

IF (N2.NE.NCHK2) THEN 

P2D=(2.*( (TH2-TH21) /DT) ) -TH21D 
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20 


* 


END IF 

IF (FLAG1.EQ.0) THEN 
P1D=(2.*((TH1-TH11) /DT) )-TH11D 
KM1=DABS (2.*TH1/(V1* ( (N1*DT) **2) )) 

END IF 

IF (N1.NE.NCHK1) THEN 
P1D=(2.*((TH1-TH11) /DT) ) -TH11D 

END IF 

N=N+1 

N2=N2+1 

N1=N14+1 

TH22=TH21 

TH12=TH11 

TH21=TH2 

TH11=TH1 


TERMINAL 
METHOD RKS FX 


* 


CONTRL FINTIM=0.8, DELT=0.00005, DELS=0.00025 
SAVE (S1) 0.005,X1DOT, P1D,TH1D,X2DOT, P2D, TH2D, TH1, TH2, ZL 
SAVE (S3) 0.005,P1,P2,TH1,TH2,RR1,RRD2 


x 
GRAPH 


GRAPH 


(L1/S1, DE=TEK618) 
TH1(LE=8, UN='RAD', LO=-0.1,SC=0.1,NI=12),... 
PID(LE=4,NI=8, LO=-4. ,UN='RAD/SEC! ,SC=2.,PO=8),... 


X1DOT (LE=4 , NI=8, LO=-4. ,SC=2.,UN='"RAD/SEC',AX=OMIT),... 


TH1D(LE=4 , NI=8, LO=-4. , UN='RAD/SEC',SC=2.),... 
ZL(LE=4,NI=8, LO=-4. ,SC=2. , AX=OMIT) 


(L2/S1,DE=TEK618,0V, PO=0, 5) 
TH2 (LE=8, UN='RAD' , LO=-.1,SC=.1,NI=12),... 
P2D(LE=4,NI=8, LO=-4. , UN='RAD/SEC!',SC=4.,PO=8),... 


X2DOT (LE=4 ,NI=8, LO=-4.,UN='RAD/SEC!',SC=4.,AX=OMIT),... 


TH2D(LE=4 ,NI=8, LO=-4. , UN='RAD/SEC',SC=4.),... 
ZL(LE=4 ,NI=8, LO=-4. ,SC=4. , AX=OMIT) 


(L3/S3,DE=TEK618) TIME(LE=8,UN='SEC'),... 
P1(LE=4,NI=4,LO=-.5,UN='RAD',SC=.5,PO=8),... 
TH1 (LE=4 ,NI=4, LO=-.5,SC=.5,UN='RAD'),... 

RR1 (LE=4 , NI=4, LO=-.5,SC=.5,AX=OMIT) 


(L4/S3 , DE=TEK618,0V, PO=0,5) TIME (LE=8,UN='SEC'),... 


P2 (LE=4 ,NI=4, LO=-.5,UN='RAD',SC=.5, PO=8),... 
TH2 (LE=4, NI=4, LO=-.5,UN='RAD',SC=.5),... 
RRD2 (LE=4, NI=4, LO=-.5,SC=.5,AX=OMIT) 


(L1) PHASE PLANE (RIGID-RIGID PLANAR ROBOT ARM) 
(L3) STEP RESPONSE (RIGID-RIGID PLANAR ROBOT ARM) 
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PARAM 
PARAM 
PARAM 


PARAM 
* 


INTGER 


* 


INITIAL 


APPENDIX G 


SIMULATION PROGRAM FOR THE TWO LINKS 


(RIGID-FLEXIBLE) PLANAR ROBOT ARM 


SIMULATION PROGRAM FOR THE ADAPTIVE MODEL, USING 
THE VELOCITY CURVE FOLLOW CONTROL S@GHEME, OF 27 
LINKS PLANAR ROBOT ARM HAVING ONE RIGID AND ONE 
FLEXIBLE LINK, USING TWO ASSUMED MODES TO EXPRESS 
THE ELASTIC MOTION OF THE FPREXIBEES EE. 

THIS SAME PROGRAM WAS USED TO OBTAIN SIMULATION 
RESULTS WITH THE SYSTEM TREATED Wile CR WitlHous 
LOAD, AS ALSO WITH OR WITHOUT GRAVITY FORCES. 


G=981.4 
ZL=0.0 


K=1.0,K1=0.8,K2=1.0, K3=10000.0,KM1=0.185, KM2=2.31 
KT1=1036.93,KT2=1036.93 
VSAT1=300.0, VSAT2=150.0 
J1=2.38,J32=2.38 
KV1=0.1012,KV2=0.1012 

BM1=3.094, BM2=3.094,L=0.0001,R=0.91 
M1=3.0,M2=1.0 

L1=40.0,L2=32.0 

E1=1.8751,E2=4.6941 

KW1=0.00124, KW2=0.0433 
REF1=1.0,REF2=1.0 

DT=0.00025 


N,N1,N2,FLAG1, FLAG2 , NCHK1,NCHK2 


N=0 

N1=0 
N2=0 
FLAG1=0 
FLAG2=0 
Q1=0.0 
Q1D=0.0 
QD=0.0 
Q2=0.0 
Q2D=0.0 
Q2DD=0.0 
TH1=0.0 
TH1LD=0.0 
TH1IDD=0.0 
TH2=0.0 
TH2D=0.0 
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TH2DD=0.0 

TH11=0.0 

TH21=0.0 
SIG1=(SINH(E1) -SIN(E1) ) / (COSH(E1)+COS(E1) ) 
SIG2=(SINH(E2) -SIN(E2) ) /(COSH(E2)+COS(E2) ) 
F1=COSH (El) -COS (E1) -SIG1* (SINH(E1) -SIN(E1) 
F2=COSH (E2) -COS (E2) -SIG2* (SINH(E2) -SIN(E2) 
A1=SQRT(2.0*KM1*VSAT1) 

A2=SQRT (2.0*KM2*VSAT2) 


) 
) 


* 


DERIVATIVE 
RR1=REF1*STEP (0.0) 
RR2=REF2*STEP(0.0) 
RRD2=TRANSP(200,0.0,0.1,RR2) 
ER1=RR1-P1 
ER2=RRD2-P2 


NOSORT 
KKKKK KKK KKK KEK KKK KKK KKK KER KK EKER KKK KKK KERR KE KKKKKK KEKE KKK KKKK 
RKEKE PARAMETERS FOR THE EQUATIONS OF MOTION KKKKKK 


KKEKEKEKKKEKEKKEKKKEHKKKKEKHKKKK KKK KKK KKK KKK KKEKEKEKEKKKEKKEKKRKEKKEKRKEKEER 

UE=F1*Q1+F2*Q2 

TH=TH1+TH2 

D122=M2*L2**2+M2*UE**2+M2*L1*L2*COS(TH2)... 
-M2*L1*SIN(TH2) *UE 

D111=D122+ (M1+M2) *L1**2+M2*L1*L2*COS (TH2)... 
-M2*L1*SIN(TH2) *UE 

D133=M2*L1*COS (TH2) *F1+M2*L2*F1 

D144=M2*L1*COS (TH2) *F2+M2*L2*F2 

D112=-2*M2*L1* (UE*COS (TH2)+L2*SIN(TH2) ) 

D113=2*M2*F1* (UE-L1*SIN(TH2) ) 

D114=2*M2*F2* (UE-L1*SIN(TH2) ) 

D1222=-M2*L1* (L2*SIN (TH2) +UE*COS (TH2) ) 

D123=D113 

D124=D114 

D1=((M1+M2) *L1*COS(TH1) +M2*L2*COS(TH)... 

-M2*UE*SIN(TH) ) *G 

D211=D122 

D222=M2*L2**2+M2 *UE**2 

D213=2*M2*F1*UE 

D223=D213 

D214=2*M2*F2*UE 

D224=D214 

D233=M2*L2*F1l 

D244=M2*L2*F2 

D2111=M2*L1* (L2*SIN(TH2) +UE*COS (TH2) ) 

D2=G*M2* (L2*COS (TH) -UE*SIN (TH) ) 

D311=M2*L1*F1*COS (TH2) +M2*L2*F1 

D322=M2*L2*F1l 

D333=M2*F1**2 

D344=M2*F1*F2 

D312=-2*M2*F1*UE 

D3222=-M2*F1*UE 
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D3111=D3222+M2*L1*F1*SIN(TH2) 
D3=G*M2*F1*COS (TH) +KW1*Q1 
D422=M2*L2*F2 
D411=D422+M2*L1*F2*COS (TH2) 
D433=D344 

D444=M2*F2**2 
D412=-2*M2*F2*UE 
D4222=-M2*F2*UE 
D4111=D4222+M2*L1*F2*SIN(TH2) 


KHRKEKKKKEKKKKEKKKKEKEKKEKEKEKKKKEKKKEKEKKEKEKEKKEKEKEKKEKEKEKRKKEKEKKKKKRKEKRKERRKKREER 


kKkKRKKK 


THE LAGRANGE'S EQUATIONS OF THE SYSTEM KKRKKK 


KHRKEKKEKKEKKEKEKKKEKEKKEKKEKEKEKEKEKEKEKEKKKEKRKEKKRERKERRKEKKRRKKEKRKEKRKRKEKRKRKRKEKRKERKREEE 


TL1=D122*TH2DD+D133*QD+D144*Q2DD+D112*TH1ID*TH2D.. 
+D113*TH1D*O1D+D114*THID2020D7bil23~2i2D-Orla. 
+D124*TH2D*QO2D+D1222*TH2D**2+D1 

TL2=D211*TH1DD+D233 *QD+D244*Q2DD+D213*THID*Ol1D... 
+D214*TH1D*Q2D+D223*TH2D*01D+D224*TH2D*Q2D... 
+DZ2111*2HID* «2702 

Q1DD= (D3 11*TH1DD+D322*TH2DD+D344*Q2DD... 

+D312*THID*TH2D+D3 21 step ~+25.. 
+DS22247R2D44 22)s) 7 bse 

Q2 DD= (D411*TH1DD+D422*TH2DD+D433*QOD... 

+D412*TH1D*TH2D+D4111*TH1ID**2... 
+D4222*TH2D**2+D4) /D444 


KHER KEKKEKEKKKEKKEKKKKKKEKEKEKKERKEKEKKEKEKKEKEKRKEKKKKEKEKEKRKRKEKERERREKEER 


kk RR RR KK THE ADAPTIVE MODEL kee KKEEKE 
ka KKK RRR KKK KK KKK RR RRR KR KEKE KKK KK KKK KAKA EK 


JTOT1=J1+D111 
JITOT2=J32+D222 
IF (ER1.LT.0.0) THEN 
X1DOT=-A1*K1*SQRT (ABS (ER1) ) 
ELSE 
X1DOT=A1*K1*SQRT(ER1) 
END IF 
IF (ER2.LT.0.0) THEN 
X2DOT=-A2*K2*SQRT (ABS (ER2) ) 
ELSE 
X2DOT=A2 *K2*SQRT (ER2) 
END IF 


KRHKKKKKKKKKKKRKR KKK KK KKK RRR KERR KK RK RRR RRR KR KRREKRKKKRKKKRAKREKE 
KKK KK KKK FIRST LINK KKKEKKKKKKKEKKE 
KHEKEKKKKKKKKRKRKR KKK RRR RRR KKK KK RRR KKK RRR KKK KK KKK RRR REE EE 


SORT 


NOSORT 


lies) 
SORT 


X1D=X1D0OT-K*P1D 
V1=LIMIT (-VSAT1, VSAT1,K3*X1D) 


TF (FLAG EOs ll) SGCe Terre 

IF (V1.LT.VSAT1.AND.TIME. Cl O7GGGe ae E.G l—) 
NCHK1=N1 

CONTINUE 

P1DD=KM1*V1 
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P1D=INTGRL(0.0,P1DD) 
P1=INTGRL(0.0, P1D) 
VP1=V1-(KV1*TH1D) 
IM1=REALPL(0.0,L/R,VP1/R) 
TM1=KT1*IM1 
TNET1=TM1-TH1D*BM1-TL1 
THIDD=(1./JTOT1) *TNET1 
TH1D=INTGRL(0.0,TH1DD) 


TH1=INTGRL(0.0,TH1D) 
KKK KKRKKKK KKK KKK KKKEKKK KK KKK KK KKK KKK IKKE KKK KKKEER 


KKKKKKKKKKKKE SECOND LINK KKAKKKKKKKKKE 
KKKKKK KK KK KKK KKK KKK KEK KR KKK KKRERKEKRERKK KKK 


X2D=X2DOT~-K*P2D 
V2=LIMIT (-VSAT2 , VSAT2 , K3 *X2D) 


NOSORT 
TF (FP UAG2ZAEO. 1) 3.6ORre 20 
Pew Zbl von Ze AND. LIME Yer. 070005) FLAGZ=1 
NCHK2=N2 
20 CONTINUE 
SORT 


P2DD=KM2*V2 
P2D=INTGRL(0.0,P2DD) 
P2=INTGRL(0.0, P2D) 
VP2=V2-(KV2*TH2D) 
IM2=REALPL(0.0,L/R,VP2/R) 
TM2=KT2*IM2 
TNET2=TM2-TH2D*BM2-TL2 
TH2DD=(1./JTOT2) *TNET2 
TH2D=INTGRL(0.0,TH2DD) 
TH2=INTGRL(0.0,TH2D) 
KKK KKKKK KKK KKK KKK RK KKK KKK KK KKK KKK KKK KKK KRKKEKEESK 


KKKKKKKK ASSUMED MODES AND FLEXIBILITY ARK KK KK 
KKK RRR KKK KKKKEKKKRKKKRKKEKK KK KRKKKKKKRKEKKEKRKKRKKKRKREKKEKRKRKEKRRKRKESE 

Q1ID=INTGRL(0.0,Q1DD) 

Q2D=INTGRL(0.0,Q2DD) 

Q1=INTGRL(0.0,Q1D) 

Q2=INTGRL(0.0,Q2D) 

FLX =-UE/L2 
KEEKKKEKEKEKEKKKKEKEKKKKEK KERR KKK EE 


kaKKKKKKKKEK SAMPLING THE SYSTEM KEKKKKKKKEK 
KKKKKK KKK KKK KKK KKK KKK KR KKK KKK KR KKK KR KK RK K KR KERR KERR KE KREKE 


SAMPLE 
* 
NOSORT 
IF (N.EQ.0) GO TO 30 
P2=TH2 
P1=TH1 
IF (N.GE.2) THEN 
TH2 1D=(TH2-TH22) /(2.*DT) 
TH11D=(TH1-TH12) /(2.*DT) 
ELSE 
TH21D=P2D 
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TH11D=P1D 
END IF 
IF (FLAG2.EQ.0) THEN 
P2D=(2.* ((TH2-TH21) /DT) ) -TH21D 
IF (N.GE.2) THEN 
KM2=DABS (2.*TH2/ (V2*((N2*DT) **2) ) ) 
END IF 
END IF 
IF (N2.NE.NCHK2) THEN 
P2D=(2.*((TH2-TH21) /DT) ) -TH2ID 
END IF 
IF (FLAG1.EQ.0) THEN 
P1D=(2.*((TH1-TH11) /DT) ) -TH11D 
KM1=DABS (2. *TH1/ (V1*((N1*DT) **2) )) 
END IF 
IF (N1.NE.NCHK1) THEN 
P1D=(2.*((TH1-TH11) /DT) ) -TH11D 
END IF 
30 N=N+1 
N2=N2+1 
N1=N14+1 
TH22=TH21 
TH12=TH11 
TH21=TH2 
TH11=TH1 
* 
TERMINAL 
METHOD RKSFX 
* 
CONTRL FINTIM=2.4, DELT=0.00005, DELS=0.00025 
SAVE (S1) 0.005,X1DOT, P1D,TH1D,X2DOT, P2D, TH2D, TH1, TH2, ZL 
SAVE (S3) 0.005,P1,P2,TH1,TH2,RR1,RRD2 
SAVE (S5) 0.005,FLX,ZL 
* 


GRAPH (L1/S1,DE=TEK618) 
TH1(LE=8, UN='RAD', LO=-.3,SC=.1,NI=16),... 
P1D(LE=4,NI=8, LO=-4. ,SC=2., UN='RAD/SEC' ,SC=2.,PO=8),..- 
X1DOT (LE=4, NI=8, LO=-4. ,SC=2.,UN='RAD/SEC' , AX=OMIT),... 
THID(LE=4 ,NI=8, LO=—-4. , UN=]"RAD/SHGUe. G—2 ae 
ZL(LE=4,NI=8, LO=-4. ,SC=2.,AX=OMIT) 
* 
GRAPH (L2/S1,DE=TEK618, OV, PO=0,5) 
TH2 (LE=8, UN='RAD!', LO=-.6,SC=.2,NI=12),... 
P2D(LE=4 ,NI=8, LO=-10. , UN="RAD/SEC! SC=5. PO=8) -aan 
X2DOT (LE=4 , NI=8, LO=-10. , UN="RAD/GHe”" ,Sc—5..,AX—-OMIT) am 
TH2D(LE=4, NI=8, LO=-10. , UN='RAD/SEC',SC=5.),... 
ZL(LE=4,NI=8, LO=-10. ,SC=5. , AX=OMIT) 
* 
GRAPH (L3/S3,DE=TEK618) TIME(LE=8,NI=8,SC=.3,UN='SEC'),... 
P1(LE=4,NI=4, LO=-.5,UN='"RAD',SC=.5 PO=8),... 
TH1 (LE=4,NI=4, LO=-.5,S$C=.5,UN='RAD'),... 
RRI (LE=4,NI=4, LO=-.5,S$C=.5,AX=OMIT) 
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GRAPH 


(L4/S3 , DE=TEK618 , OV, PO=0,5) 


TIME (LE=8 ,NI=8,SC=.3,UN='SEC'),... 

P2 (LE=4,NI=6, LO=-.5, UN='RAD' ,SC=.5,PO=8),... 
TH2 (LE=4 , NI=6, LO=-.5, UN='RAD' ,SC=.5),... 
RRD2 (LE=4 , NI=6, LO=-.5,SC=.5,AX=OMIT) 


(L9/S5,DE=TEK618) TIME(LE=8,UN='SEC!',NI=8,SC=.3),... 


(L1) 
(L3) 
(L9) 


FLX (LE=6, LO=-2. , NI=8,SC=.5),... 
ZL(LE=6, LO=-2.,NI=8,SC=.5,AX=OMIT) 


PHASE PLANE (RIGID-FLEXIBLE PLANAR ROBOT ARM) 


STEP RESPONSE (RIGID-FLEXIBLE PLANAR ROBOT ARM) 
FLEXIBLE MOTION OF THE END-POINT 


5k: 


LO. 


et 
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